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Preface 


The  purpose  of  this  study  was  to  investigate  the 
potential  utility  of  the  linearized  Kalman  filter-smoother 
as  a  tool  for  aircraft  mishap  investigations.  The  intention 
was  to  produce  a  computer  analysis  tool  which  could 
accurately  reproduce  the  forcing  functions  required  to 
generate  a  specified  aircraft  trajectory.  This  information 
is  often  of  value  to  mishap  investigation  boards  in 
determining  probable  pilot  actions. 

The  resulting  algorithm  was  subjected  to  a  noise 
strength  sensitivity  study,  a  measurement  device  precision 
study,  and  a  study  to  determine  the  effects  of  multiple 
iterations  of  the  algorithm.  The  evaluation  showed  that  the 
algorithm  performed  well  and  generated  useful  results. 
However,  limitations  in  the  current  implementation  were 
discovered.  As  a  result  of  these,  the  systematic  generation 
of  nominal  trajectories  and  elimination  of  unrealistic 
output  transients  were  identified  as  topics  for  further 


study . 


In  developing  the  algorithm,  evaluating  its 


performance,  and  writing  the  report,  I  have  had  a  great  deal 
of  assistance.  I  am  deeply  indebted  to  my  faculty  advisor. 
Dr.  Peter  S.  Maybeck,  without  whose  assistance  and 
persistence  this  effort  would  have  been  difficult  if  not 
impossible  to  complete.  My  other  thesis  committee  members. 


-l  l- 


I 

Dr.  Robert  A.  Calico  and  Maj.  Daniel  Gleason,  also  spent 
considerable  effort  on  this  project,  which  I  gratefully 
acknowledge.  I  am  indebted  to  Col.  Daniel  J.  Biezad  for  his 
assistance  in  reviewing  the  document.  I  also  wish  to  thank 
my  supervisor,  Mr.  Thomas  D.  Morgan,  who  made  it  possible 
for  me  to  have  access  to  the  office  during  the  long  evenings 
and  weekends  that  the  work  often  required;  and  a  fellow  AFIT 
student,  Mr.  John  T.  Browne,  for  his  many  helpful 
suggestions . 

Finally,  and  most  importantly,  I  wish  to  thank  my 
parents,  Blanche  M.  Ruley  and  the  late  Joseph  A.  Ruley,  MSGT 
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Abstract 


The  purpose  of  this  study  was  to  investigate  the 
potential  utility  of  the  linearized  Kalman  filter-smoother 
algorithm  as  a  tool  for  aircraft  mishap  investigations.  The 
immediate  objective  was  to  develop  computer  software  to  make 
possible  an  investigation  of  the  algorithm's  capabilities 
for  generic  aircraft  trajectories.  Other  objectives 
included  determination  of  the  sensitivity  of  the  algorithm 
to  noise  strength  variations,  evaluation  of  its  performance 
with  measurement  devices  of  differing  precisions,  and 
determination  of  the  potential  for  iterative  improvement  of 
the  results.  All  of  these  objectives  were  achieved. 

The  primary  finding  of  this  study  was  that  the 
linearized  Kalman  filter-smoother  technique  is  a  viable  one 
for  mishap  trajectory  analysis,  and  that  the  algorithm  as 
implemented  could  be  useful  in  actual  mishap  investigation 
work . 

The  study  also  found  that,  although  the 
effectiveness  of  the  current  algorithm  is  limited,  some  of 
the  limitations  could  be  removed  through  further  work.  In 
particular,  systematic  nominal  trajectory  generation  and 
control  of  unrealistic  transients  in  the  filter-smoother 


output  warrant  further  attention.  Suggested  methods  for 
addressing  these  problems  are  included  in  the  report. 
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APPLICATION  OF  LINEARIZED  KALMAN  FILTER-SMOOTHER 
TO  AIRCRAFT  TRAJECTORY  ESTIMATION 


I.  Background  and  Problem  Statement 


The  Flight  Stability  and  Control  Branch  at 
Aeronautical  Systems  Division  ( ASD/ENFTC )  is  often  called 
upon  to  assist  accident  boards  in  aircraft  mishap 
investigations.  Support  provided  by  ENFTC  has  frequently 
included  generation  of  probable  mishap  aircraft 
trajectories,  and  analysis  of  known  or  estimated 
trajectories  to  determine  probable  pilot  actions. 

This  author  has  expended  considerable  effort  in 
producing  computer  software  to  assist  in  these  tasks.  Two 
major  computer  programs  especially  intended  for  mishap 
investigation  work  have  been  written  by  the  author.  The 
first  of  these,  called  PMSIM  (point-mass  simulation)  (Ruley, 
1987b)  is  a  three  degree-of-f reedom,  force-equation  aircraft 
model  for  trajectory  generation.  It  generates  the  aircraft 
flight  path  in  inertial  space,  using  initial  conditions  and 
forcing  functions  supplied  by  the  user.  The  second  program, 


oVX o.  of ^  •* *_  •" -V‘ *  •'«  •* .  *; . 


OPSIM  (optimal  simulation)  (Ruley,  1987a)  is  a  routine  to 
develop  forcing  functions  which  attempt  to  get  the  PMSIM 
model  states  to  match  a  given  trajectory  closely.  The  OPSIM 
program  works  by  varying  the  forcing  functions  to  attempt  to 
minimize  a  cost  functional,  defined  as  a  user-specified 
combination  of  the  states  and  time.  This  procedure  is 
performed  for  each  segment  of  the  trajectory  sequentially, 
until  the  entire  trajectory  has  been  matched. 

Both  OPSIM  and  PMSIM  have  been  of  assistance  to 
ENFTC  engineers  in  actual  mishap  investigation  work. 

However,  the  capability  of  OPSIM  to  develop  physically 
reasonable  forcing  functions  is  limited  by  the  algorithm  it 
employs.  The  goal  of  this  algorithm  is  to  produce  a 
computed  trajectory  which  matches  each  of  the  trajectory 
data  points  exactly,  without  regard  to  data  noise  corruption 
which  is  almost  always  present.  This  often  results  in 
unrealistic  variations  in  the  forcing  functions. 
Additionally,  there  is  no  quantitative  measure  of  the 
quality  of  the  trajectory  and  forcing  function  data 
generated . 

With  these  deficiencies  in  mind,  the  author 
considered  other  methods  of  attacking  the  trajectory 
generation  problem.  He  concluded  that  stochastic  estimation 
and  control  methods  could  be  expected  to  be  useful  for  the 
problem,  since  they  would  explicitly  account  for  noise 
corruption  of  both  the  physical  system  and  the  measurement 
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devices.  Additionally,  the  estimation  error  covariances  of 
the  trajectory  states  and  forcing  functions  would  be 
computed,  and  would  provide  a  quantitative  measure  of  the 
uncertainty  in  the  results. 

The  author's  purpose  in  this  thesis  project  was  to 
duplicate  the  function  of  the  OPSIM  program  using  the 
approach  of  a  fixed-interval,  linearized  Kalman  filter- 
smoother,  and  to  validate  the  capabilities  of  the  resulting 
program.  This  task  is  outlined  more  completely  in  the 
following  problem  statement. 


1 . 2  Problem  Statement 

The  linearized  Kalman  filter-smoother  technique  will 
be  applied  to  the  problem  of  aircraft  trajectory  estimation 
in  three  dimensions.  Computer  software  to  perform  this  task 
for  generic  aircraft  trajectories  will  be  developed.  The 
potential  for  improving  the  match  by  successive  iterations 
of  the  filter-smoother  algorithm  will  be  investigated. 
Measures  of  merit  for  determining  the  closeness  with  which 
the  resulting  trajectories  match  the  actual  trajectory  will 
be  investigated.  These  will  include  the  filter-smoother 
state  and  control  perturbations,  the  diagonal  elements  of 
the  filter-smoother  computed  state  covariance  matrix,  and 
the  change  in  the  filter-smoother  nominal  trajectory  from 
iteration  to  iteration.  A  means  of  estimating  the  forcing 


m 
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II 


Problem  Formulation  and  Detai led  Algorithm  Development 


2 . 1  Ai rcraf  t  Model  Formula  tion 

In  this  section,  the  force  equations  for  a  rigid 
aircraft  moving  in  three  dimensions  will  be  presented,  and 
then  linearized  to  obtain  a  form  which  will  be  shown  to  be 
usable  in  the  Kalman  filter-smoother  algorithm.  Addition¬ 
ally,  simplifying  assumptions  and  singularities  will  be 
discussed . 

The  coordinate  system  shown  in  Figure  1  will  be  used 
to  develop  the  aircraft  equations  of  motion.  The  coordinate 
axes  (X,  Y,  Z),  with  origin  at  the  fixed  point  0,  will  be 
referred  to  as  the  inertial  axes.  They  form  a  right-handed 
coordinate  system,  with  X  and  Y  positive  in  the  "north"  and 
"east"  directions,  respectively,  and  Z  positive  downward. 

For  convenience,  the  coordinate  h,  defined  by  h  =  -Z  , 
will  be  used  for  actual  computations. 

The  aircraft  center  of  mass  is  located  at  the  point 

P,  which  becomes  the  origin  for  the  wind-axis  coordinate 

system  (Xw,  Yw,  Zw) .  These  axes  are  defined  so  that  the 

Xw~axis  is  colinear  with  the  aircraft  velocity  vector,  the 

Y  -axis  is  orthogonal  to  the  X  -axis  and  lies  in  the 
w  w 

aircraft  plane  of  symmetry,  and  the  Zw  (or  h  )  axis  lies 
perpendicular  to  that  plane  of  symmetry.  The  orientation  of 


Figure  1.  Wind  and  Inertial-Axis  Coordinate  Systems 


the  wind  axes  with  respect  to  the  inertial  axes  is  defined 
by  the  Euler  angles  X,  "Y,  and  p  as  follows.  Let  us  first 
define  a  set  of  coordinate  axes  parallel  to  the  inertial 
axes  but  with  the  origin  at  point  P.  This  axis  system  is 
rotated  about  the  Z-axis  until  the  X-axis  lies  directly 


"underneath"  the  aircraft  velocity  vector,  forming  a  "new" 
set  of  coordinate  axes.  This  rotation  defines  the  wind-axis 
heading  angle,  X.  Next,  this  "new"  set  of  axes  is  rotated 
about  its  Y-axis  until  the  X-axis  becomes  colinear  with  the 
velocity  vector,  forming  another  "new"  set  of  axes.  This 
rotation  defines  the  wind-axis  pitch  attitude,  V,  which  is 
also  referred  to  as  the  flight  path  angle.  Finally,  the 
"new"  axes  are  rotated  about  the  X-axis  until  the  Z-axis  is 
perpendicular  to  the  aircraft  plane  of  symmetry.  This 
defines  the  wind-axis  roll  attitude,  fi . 

The  force  equations  for  a  rigid  aircraft  moving  in 
three  dimensions,  expressed  in  the  wind-axis  coordinate 
system  are  (Etkin,  1972:  149): 


MV  *  T  -  D  -  MgsinY 
Xw 


MVr  *  T  -  C  +  MgcosYsinp 
w  yw 


-MVqw  =  Tz  -  L  +  MgcosYcos 
w 


where : 


Tx  ,  T  ,  Tz  are  components  of  thrust  in  the 
w  yw  w 

directions  of  the  X  - ,  Y  - ,  and  Z  -  axes 

w  w  w 

L  is  lift 
C  is  side  force 


D  is  drag 


m  is  mass 


g  is  the  acceleration  due  to  gravity 


V  is  velocity 


qw  is  wind-axis  pitch  rate 

r  is  wind-axis  yaw  rate 

w 


(')  denotes  the  time  derivative  (this  symbol  will  be 
so  used  throughout  the  report). 

The  kinematic  relationships  between  wind-axis  Euler 
angles  and  angular  rates  are  given  below  (Etkin,  1972:  150): 


’  m  qwc°sP  -  rwsln^ 

X  =  (qwsin^  -  rwcos^)/cos> 


For  mathematical  simplicity,  let  us  now  assume  that 
the  thrust  acts  along  the  X  -  axis,  and  that  side  force  is 
negligible,  which  generally  also  implies  negligible  sideslip 
angle.  These  assumptions  are  adequate  for  a  wide  variety  of 
trajectory  analysis  tasks,  particularly  those  in  which  the 
aircraft  operates  at  small  to  moderate  angles  of  attack, 
does  not  posess  vectored  thrust  capability,  and  is  equipped 
with  a  flight  control  system  providing  automatic  turn 
coordination,  as  is  often  the  case  with  modern  USAF 
aircraft.  With  these  assumptions,  we  may  write: 


where  W  is  the  weight,  and  n  is  defined  as  the  load  factor. 

Using  this  notation  and  the  assumptions  of  Eqs  (6), 
(7),  and  (8),  the  force  equations  become: 


» 


Tx 

w 

.  T 

(7) 

rt 

/ 

C 

-  0 

(8) 

» 

V 

V 

'4 

* 

total 

thrust. 

/ 

also 

introduce 

the  following  notation: 

1 

? 

W  = 

Mg 

(9) 

n  = 

L/W 

(10) 

» 

v  *  (g/w)  (T  -  D  -  WsinY) 

(ID 

1 

■ 

« 

X  =  (ngsiny) / (VcosV) 

(12) 

y  =  (g/V)  (ncosj;  -  cosy) 

(13) 

• 

The  relationships  between  velocities  in 

the  inertial 

and  wind-axis  coordinate  systems  are  given  below 

(Etki n , 

1972  :  150)  : 

1 

X  «  VcosycosX 

(14) 

Y  =  VcosysinX 

(15) 

h  =  Vsiny  *  -Z 

(16) 
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The  set  of  equations  given  by  (11)  -  (16)  may  be 

used  to  generate  aircraft  trajectories,  given  knowledge  of 
the  relevant  variables,  by  simultaneous  integrations. 
However,  these  equations  are  highly  nonlinear.  To  employ  a 
Kalman  filter-smoother  algorithm  for  trajectory  analysis,  it 
is  advantageous  to  linearize  the  trajectory  equations  about 
a  nominal  trajectory.  When  this  is  done  using  a  Taylor 
series  expansion,  keeping  only  the  linear  terms,  the  results 
ar  e : 


<5V  =  -gcosv0ar  +  (g/W )  fiT  -  (g/W)  (|Sfiv  +  |£dn)  (17) 

<J-i  =  -  (g/V02)  (n0cos/iQ  -  cos  >Q )  fiV 

+  (g/VQ)  sin>oay  -  (n0g/VQ)  sin^0<5*i 

+  (g/V0)cosji06n  (18) 

6X  *  -  (n0gsin/i0/V02cosV0)  «V 

2 

+ (n0gsinn0sinr0/V0cos  V0)i> 

+ (n0gcosp0/V0cosV0)fiy  + (gsin^0/VQcos>0) <5n  (19) 

<5h  =  sinV^SV  +  VQCOs>0(5y  (20) 

6Y  =  cos>0sinX06V  -  V0sinT0sin XQ(5y  +  V0cos V0cosX0iX  (21) 

ax  =  cosy0cosX0«V  -  VQsinV0cosX0ay  -  V0cosy0sinx0ax  (22) 


where : 


the  subscript  _  refers  to  the  nominal  trajectory 


fi(  ) 


=  (  )  -  (  )q  is  the  perturbation  of  each 
variable  about  the  nominal  trajectory 


~  is  the  partial  derivative  of  drag  with  velocity 

—  is  the  partial  derivative  of  drag  with  load 
dn 

factor 

Eqs  (17)  -  (22)  constitute  a  linearized  model  for 
small  perturbations  about  the  nominal  trajectory.  They  may 
be  transferred  to  state-space  notation  as  follows: 

fix(t)  =  F(t)fix(t)  +  B(t)fiu(t)  (23) 


where : 


fix(t)  =  [fiV  by  bX  6h  fiY  fix  ] T  (24) 

fiu(t)  =  [bn  fin  fiT ] T  (25) 

and  matrices  F(t)  and  B(t)  are  composed  of  the  coefficients 
of  Eqs  (17)  -  (22) . 

We  note  that  this  linearized  model  contains 
singularities  at  Vq  =  0  and  cosYq  =  ®  at  zero 

nominal  velocity  or  vertical  nominal  flight  path.  The 
singularity  at  zero  velocity  is  of  no  great  concern,  as  this 
condition  is  not  physically  reasonable  for  heavier- than-air 
aircraft  without  vectored  thrust.  The  singularity  which 


iVtV&^a 
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occurs  when  the  flight  path  becomes  vertical  is  of  more 
concern,  but  we  note  that  it  only  occurs  in  one  equation,  Eq 
(19).  Therefore,  so  long  as  sustained  vertical  flight  is 
not  to  be  modelled,  it  is  computationally  sufficient  to 
avoid  this  singularity  by  setting  Eq  (19)  to  zero  whenever 
the  flight  path  is  "close"  to  vertical.  For  computational 
purposes,  this  may  be  done  by  monitoring  the  absolute  value 
of  cos>q  and  setting  X  =  0  whenever  the  absolute  value  is 
less  than  some  small  tolerance  e  (c=0.0001  in  the 
implementation  used).  Of  course,  this  will  result  in  a 
discontinuity  in  X  when  passing  through  the  vertical,  but  X 
will  remain  continuous  and  any  resulting  effects  are  not 
expected  to  be  significant. 

This  completes  the  development  of  the  linearized 
form  of  the  force  equations  for  aircraft  trajectory 
estimation.  The  Kalman  filter-smoother  algorithm  will  now 
be  presented. 


2 . 2  Filter-Smoother  Algorithm 

Let  a  discrete-time  state  perturbation  model  of  an 
arbitrary  physical  system  be  given  by: 


+  =  *(ti  +  1,  ti)6x(ti)  +  6ud(ti)  +  flwd(ti)  (26) 


where : 


6x(t^)  is  the  perturbation  state  vector 
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6ud<t:  ^) is  the  perturbation  control  vector 

(Note:  this  formulation  assumes  that,  with  proper 
discretization,  the  discretized  control  input 
matrix  may  be  set  equal  to  the  identity  matrix. 
This  is  done  for  reasons  of  computational 
convenience  which  will  be  discussed  later). 

6wd(ti}  is  a  perturbation  dynamic  driving  noise 
input  vector,  which  is  assumed  to  be  well 
represented  by  di screte-time  white  Gaussian  noise 
with  statistics: 


E{6wd(ti) }  =  0. 


(27) 


E{£wd(ti)i*dr(tj) > 


£d(ti),  i-j 
0 ,  i#  j 


(28) 


*(t^+^,  t^)is  the  state  transition  matrix 
associated  with  matrix  F(t)  of  Eq  (23) 

Now  let  a  di screte-time  measurement  model  be  given 


z(ti)  *  h(x(ti)  ,  ti)  +  v(tA) 


(29) 


where : 


2(t^)  is  the  state  measurement  vector 
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h(x(t^)f  t^)  is  a  vector  function  representing  the 
measurement  device(s) 

^(t^)  is  the  measurement  corruption  noise  vector, 
which  is  assumed  to  be  well  represented  by 
di screte-time  white  Gaussian  noise  with 
sta  tistics: 


E{v(ti) }  =  0 


E{v(ti) v1 (t j) }  = 


R(ti),  i  =  j 


Assuming  that  a  nominal  trajectory  is  available, 
along  with  measurements,  a  measurement  perturbation  6z  ( t^ ) 
may  be  defined  in  a  manner  analogous  to  the  state 
perturbation,  using  a  Taylor  series  expansion: 


z<v  ■  vv  *  a~s!it’S'  v  4*<v  +  i(ti> 


or  equivalently,  in  terms  of  i_z  ( t^)  =  -  .Zgft^): 


lz(ti)  =  H(ti)«x(ti)  +  v(ti)  (: 


ov  o’  v-v: 


where  H(t^)  is  the  measurement  matrix,  which  is  a  function 
of  the  nominal  trajectory  states  and  time,  as  shown. 

To  generate  a  time  history  of  the  measurement 
perturbation  J)z(t^)  for  purposes  of  computation,  we  apply  Eq 
(29)  to  obtain: 


«z(ti)  =  z(ti)  -  h(xQ(ti)  ,  ti) 


where : 


jz(t^)  is  the  actual  measurement  time  history 
—  ( 2£g  ( t i  )  ,  t ^  )  is  a  measurement  representation 

based  on  the  nominal  trajectory  and  is  assumed  to 
be  error-free,  since  it  is  assumed  that  the 
nominal  trajectory  was  generated  in  a 
deterministic,  noise-free  manner. 


Therefore,  the  measurement  perturbation  time  history 
may  be  assumed  to  have  the  same  noise  statistics  as  the 
measurement  time  history  itself,  provided  that  the 
first-order  Taylor  series  expansion  itself  introduces  no 
significant  additional  noise  corruption.  Accordingly,  Eqs 
(30)  and  (31)  describe  the  error  statistics  of  the 
measurement  perturbation,  as  well  as  the  measurement  itself. 

Given  Eqs  (26)  -  (34) ,  the  Fraser  form  of  the 
equations  for  a  fixed-interval  filter-smoother  algorithm  may 
be  formulated  (Maybeck,  1982:  9-11).  Note  that  in  these 


equations,  we  have  set  B^t^  =  Gd(tx)  =  -  (the  identity 
matrix),  as  shown  in  the  state  model  given  by  Eq  (26).  With 
this  assumption,  the  filter-smoother  algorithm  is  given  by 


V 

.%• 


the  equations  below.  (Note  that  it  is  possible  to  use 


filter  algorithms  of  a  different  computational  form,  such  as 
U-D  factorization  or  square  root  (Maybeck,  1979:  368-405), 
if  computer  numerical  accuracy  limitations  require  it.  This 
was  not  required  in  the  current  implementation.) 


a )  Forward  Filter: 
i)  Propagation  cycle: 


*£(ti  +  1‘)  *  f  (ti  +  1,  ti)*x(ti  )  +  fiud(ti) 


+  v,T 


P(ti+1  )  »  i(ti+1,  ti)P(t.  )*  (ti+1,  tA)  +fid(ti)  (36) 


ii)  Measurement  update: 


K  ( fci ) 

6 x  ( t  i  + ) 
P(ti+) 


P(ti')HT(ti) (H(ti)P(ti")HT(ti)  +R(t1)]’1  (37) 
+  K(ti)  [fiz  (ti)  -  H  (ti)  «x(ti_)  ]  (38) 

P(ti")  -  K  (ti)H (ti)P(ti_)  (39) 


where  P(t^)  is  the  state  covariance  matrix,  and  the 
superscripts  -  and  +  refer  to  before  and  after  measurement 


incorporation,  respectively. 

The  forward  filter  is  iterated  forward  in  time 
(increasing  k)  from  the  following  initial  conditions: 
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6ud(ti)  =  0  (all  i) 


(40) 

(41) 

(42) 


$ 


where  is  a  matrix  of  assumed  initial  values  for  the 
covariance,  and  Eq  (42)  will  be  shown  to  hold  true  later. 


b)  Backward  Filter; 
i)  Measurement  update: 


£b 


where,  for  either  t^  or  t^  : 


2b<‘i>  -  fb'^V^b'h 


(49) 
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2b(ti+l  *  2b(ti")  +  HT<V£'1<ti)«z(ti) 

(43) 

to 

fV> 

V  1 

V 

1<ti+)  =  Pb”1(ti-)  + 

(44) 

• 

& 

ii) 

Propagation  cycle: 

; 

1  bV 

i 

a  ( t± ) 

*  +  ya'hti.i))'1 

(45) 

1 

L(  t±) 

=  I  -  J(ti) 

(46) 

$ 

2b«Vf> 

*  iT<V  'i-i'KV  lib'h*1 

» 

V, 

(47) 

$ 

v 

'1<ti-r> 

=  *T<V  ti_i>  Si  ( 1  i  ^b"1  ( ti+'iT  *  fci  ^ 

N 

«  *“  4 

*  J(ti>2d'1(ti_i)jT(ti)]*(ti,  ti_1) 

(48) 

h 

S3 


I. 

r%- 

o 

r.yi 
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and  6xb ( )  is  the  backward  filter  state  perturbation 


estimate  (which  is  never  actually  computed  in  this 


formulation) 


The  backward  filter  is  iterated  backward  in  time 


(decreasing  k)  for  the  following  final  conditions: 


2b <‘f>  ■  S. 


«ud(ti)  =  0  (all  i) 


where  Eqs  (50)  and  (51)  express  the  fact  that  the  final 


state  is  not  known  a  priori. 


c )  Smoothed  Estimate : 


i)  State  Perturbation  Gain  Computation: 


X(t.) 


[I  +  P(ti+)Pb'1(ti") ]_1 


W(  tA) 


P(ti+)XT(ti) 


Y(ti) 


=  I  -  W(ti)Pb  A(ti  ) 


ii)  State  Perturbation  Estimate: 


PttVtj)  =  Y(ti)P(ti+)YT(ti)  +  W(ti)Pb‘1(ti")WT(ti)  (55) 


«x(ti/tf)  =  X(ti)6x(ti  )  +  P(ti/tf)^b(ti") 
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iii)  Control  Gain  Computation: 


V(ti)  *  £d(ti)*T(ti,  ti  +  1)  -  fid(ti)  [f'1  (ti  +  1,  (57) 

Ku ( t± )  =  V(ti)XT(ti)  (58) 


iv)  Control  Perturbation  Estimate: 

i£d,ti/tf) 

where  Ud(t^/t^)  is  the  smoothed  estimate  of  the  covariance 
of  the  control  perturbation  6ud  ( t  Vt^ )  • 

The  smoothed  estimate  is  iterated  forward  in  time 
(increasing  k),  in  parallel  with  the  forward  filter  if  so 
desired,  after  all  elements  of  the  backward  filter  results 
have  been  computed  and  stored  in  memory.  The  assumption  of 
Eq  (42)  is  also  used  in  the  smoother,  and  is  applied  in  Eq 
(59)  . 

This  completes  the  presentation  of  the  Kalman 
filter-smoother  algorithm.  We  will  now  see  how  the 
perturbation  state  model  developed  in  Eqs  (17)  -  (23)  may  be 
adapted  to  this  algorithm. 


*  «W  *  W  lib11!’1 

-  £b‘1(ti‘)i2(ti+)J  (59) 

-  vitpp^htj'iKjup  <ec> 
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2 . 3  Filter -Smoother  Applied  to  the  Aircraft  Model 

In  this  section,  the  perturbation  state  model  for 
the  aircraft  will  be  shown  to  be  compatible  with  the 
filter-smoother  algorithm,  thus  forming  a  complete  algorithm 
for  trajectory  analysis.  Let  us  begin  by  restating  the 
state-space  form  of  the  perturbation  state  model,  given  in 
Eq  (23): 


6x(t)  =  F(t)6x(t)  +  B(t)6u(t)  (23) 


This  is  the  model  of  the  aircraft  when  subjected  to 

deterministic  inputs  only.  Dynamics  driving  noise  terms, 

which  would  be  due  in  the  physical  world  to  such  effects  as 

wind  gusts,  turbulence,  control  system  dynamics,  and  pilot 

inputs,  may  also  be  present.  They  may  be  accounted  for  in 

the  following  manner.  Let  us  first  deal  with  wind  gusts 

directly,  assuming  that  the  wind  vector  has  components  V  , 

w 

V  ,  and  V  .  Eqs  (14)  -  (16)  become: 
yw  zw 


X'  =  VcosVcosX  +  V 

x 


(61) 


Y- 


VcosYsinX  + 


h'  = 


(62) 


VsinY  -  V„ 


(63) 
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With  the  addition  of  these  wind  components. 


Eqs  (20)  -  (22)  become: 


6h'  =  ah  -  av 


a y'  =  ay  +  av 


ax'  =  ax  +  av 


Let  us  now  add  noise  inputs  to  Eqs  (17)  -  (19), 
assuming  for  computational  convenience  that  the  noises  are 
added  at  the  points  of  entry  of  the  deterministic  controls. 
The  equations  become: 


av*  «  av  -  (g/W)|^aw2 (t)  +  (g/W)dw3(t> 


ay'  *  av  -  (nQg/V0)  sin^oaw1  (t)  +  (g/v0)  cos>i0«v2  (t)  (68) 

ax'  =  ax  +  (n0gcosji0/V0cosV0 )  aw^  ( t) 

+  (gsin^0/V0cosT0) aw2 (t)  (69) 

where  aw^(t),  dw2(t),  and  aw^(t)  are  the  dynamics  driving 
noise  components  added.  These  noises  are  not  as  easily 
related  to  the  physical  world  as  wind  gust  inputs,  but 
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certainly  it  is  reasonable  to  assume  that  actual  noise 
sources  such  as  turbulence  and  control  system  effects  could 
be  considered  to  manifest  themselves  in  this  manner.  If  the 
wind  gust  inputs  are  now  identified  as  additional  components 
of  the  noise  perturbation  input  vector  6w(t),  the 
state-space  model  given  in  Eq  (23)  (dropping  the  primed 
notation)  may  be  rewritten  as: 


6x(t)  =  F(t)6x(t)  +  B(t)fiu(t)  +  G(t)6w(t) 


(70) 


Let  us  assume  that  the  noise  perturbation  ^w(t)  is 
well  represented  by  white  Gaussian  noise,  with  statistics: 


non-Gaussian-distributed  noise,  will  not  be  examined  in  this 
thesis.  It  is  considered  sufficient  for  the  purposes  of 
this  study  to  consider  only  Gaussian  noise,  as  the  central 
limit  theorem  implies  that  noise  sources  in  the  physical 
world  tend  to  be  describable,  or  at  least  well  approximated, 
as  Gaussian  (Maybeck,  1979:  109).  Moreover,  the  low-pass 
filtering  characteristics  of  real-world  systems  tend  to  make 
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E{ 6w( t) }  » 

0 

(71) 

V, 

yt 

« i 
\* 

E{6w(t) 6wT  (t1  )  }  = 

2(t) d(t-t') 

(72) 

I  ! 

s: 

where  fi(t-t')  is  the  Dirac  delta 

function,  and  £)(t) 

is  the 

$ 

noise  strength  matrix. 

1 

3 

a  * 

The  effects  of  non-white 

Gaussian  noise,  or 
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possible  the  assumption  that  input  noise  is  white  (Maybeck, 

1979:  7-8).  Should  a  noise  input  structure  which  more 

exactly  describes  the  noise  input's  time  correla tedness  be 

required,  shaping  filters  (Maybeck,  1979:  180-190)  of 

appropriate  form  could  be  developed  and  the  necessary 

additional  states  added  to  the  system  model,  but  this  will 

not  be  pursued  further  here. 

Let  us  now  consider  how  Eq  (70)  may  be  discretized 

in  order  to  perform  a  solution  on  a  digital  computer. 

Suppose  we  assume  that  fiu(t)  is  to  be  held  constant  over  a 

small  time  interval,  denoted  by  At  =  t.  ,  -t-  .  This 

l  +  l  l 

assumption  is  not  very  restrictive,  as  At  may  be  set  to  a 
small  enough  value  to  justify  it  for  any  particular  problem. 
With  this  assumption,  the  discretized  form  of  Eq  (70)  may  be 
written  as: 


-^i  +  l'  T)B(T)ju(T)dT 


s: 


r)G(r)dw(T)dr  (73) 


(in  the  non-rigorous  white  noise  notation)  or,  more  simply: 


—  (ti  +  l)  =  *(ti  +  l'  ti)ix(ti)  +  «ud(ti)  +  dwd (ti)  (74) 
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where : 


and  6 


where : 


£d(t 


(t. 


T  )  B  (r)  iu(r)  dr 


T)G(T)!w(T)dT 


(75) 


(76) 


(t^)  has  statistics  given  by  (Maybeck,  1979:  171): 


E{6w^ (ti)  )  =  0 


(77) 


£d(ti>'  1  =  j 
o,  i*i 


(78) 


) 


T)G(T)£(r)GT(T)*T(ti  +  1,  T)d T 


(79) 


Now,  in  order  to  evaluate  the  state  transition 


matrix  and  the  various  integrals  on  a  digital  computer, 
approximations  must  be  made.  For  a  time  step  At  which  is 


sufficiently  small  compared  to  the  system's  natural 
transients,  the  state  transition  matrix  may  be  evaluated  as 
follows  (Maybeck,  1979:  357): 

N 

*(v  ti-i)  *  I-(ti-l)  ]k(At)k  (80) 

k  =  0 

N,  the  number  of  terms  to  which  the  series  is 
actually  taken  for  evaluation,  must  be  set  to  yield  the 
desired  accuracy.  It  is  uncommon  to  take  N  to  be  greater 
than  two,  since  At  may  be  chosen  appropriately  small  for  any 
desired  problem.  N  =  2  was  chosen  for  this  particular 
implementation. 

The  integral  in  Eq  (75)  may  be  evaluated,  using  the 
trapezoidal  rule,  as  follows: 

IVV  =  i[*(ti+l'  ti)B(ti)5u(ti) 

+  B(ti+1)«u(ti+1) ] At  (81) 

Note  that  for  the  chosen  perturbation  form  of  the 
model,  however,  that  fijj^(t^)  *  £  for  all  i.  This  is  true 
because  Eq  (81)  will  always  yield  a  zero  result,  since  each 
term  includes  a  factor  of  iu(t^),  and  no  deterministic 
control  input  perturbations  are  made.  This  demonstrates  the 
validity  of  the  assumption  made  in  Eq  (42). 


Finally,  the  discrete  noise  strength  matrix  £^(t^) 
(Eq  (79))  may  itself  be  evaluated  using  the  trapezoidal 
rule,  to  yield  (Maybeck,  1979:  358): 

£d(V  *  I[*{ti+i'  ti)5(ti)2(ti)GT(ti)*T(ti  +  1,  t.) 

+  £(ti+i)2(ti+1)GT(ti+1)]At  (82) 

The  model  of  the  aircraft  is  now  in  the  required 
form  for  estimation  using  the  filter-smoother  algorithm. 

Eq  (74)  is  of  the  same  form  as  Eq  (26) ,  and  means  of 
evaluating  the  state  transition  matrix  and  discrete  noise 
strength  matrix  have  been  presented  in  Eqs  (80)  and  (82). 

To  complete  the  set  of  equations  needed  to  implement 
the  filter-smoother,  it  is  necessary  to  establish  a 
measurement  model  of  the  form  given  in  Eq  (29).  Such  a 
model  can  be  developed,  on  a  case-by-case  basis,  from 
physical  descriptions  of  the  measurement  devices  available. 
For  example,  a  tracking  radar  might  be  used  to  measure 
range,  range  rate,  elevation  angle,  and  azimuth  angle  data, 
which  may  be  expressed  as  functions  of  the  inertial 
coordinates  X,  Y,  and  h  through  the  function  h(x(t^),  t^). 
Alternatively,  a  head-up  display  (HUD)  device  in  the 
aircraft  itself  might  be  capable  of  recording  velocity, 
flight  path  angle,  and  heading  angle  data,  which  might  be 
usable  directly  or  might  need  to  be  corrected  for  angle  of 
attack  and  sideslip  angle.  The  statistics  of  the  various 
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noise  processes  involved  would  have  to  be  considered  in 
developing  the  matrix  R(t^)  in  Eq  (31).  For  the  purposes  of 
this  section,  however,  it  is  sufficient  to  assume  that  a 
measurement  model  exists  or  may  be  developed.  The  white 
noise  assumption  for  measurement  corruption  noise  is  good  if 
the  measurement  sample  period  is  long  compared  to  the  noise 
correlation  time,  which  is  a  rather  nonrestrictive 
condition. 

One  aspect  of  the  trajectory  analysis  problem 
remains  to  be  addressed,  which  is  the  estimation  of  control 
input  perturbations  using  the  filter-smoother  output.  This 
is  an  important  part  of  the  problem,  as  the  magnitude  of 
such  estimates  gives  an  indication  of  both  the  correctness 
of  the  nominal  control  inputs  used  to  generate  the 
trajectory,  and  the  amount  of  input  noise  corruption 
present.  Returning  to  Eq  (75)  for  du^ft^),  we  see  that  an 
alternative  approximation  for  this  integral,  good  to  first 
order  in  At,  is  given  by: 


«ud(ti)  =  B(ti)«u(ti)At 


for  a  time  step  At  which  is  sufficiently  small  in  comparison 
to  the  system's  natural  transients.  Expanding  Eq  (83),  we 
obtain: 


VaVaV.nV.'.v 


«ud  (ti)  *  [-(g/W)|^dn(ti)  +  (g/W)6T]At  (84) 

6ud2(ti)  *  ["  (n0g/V0)  sin^0  a#i(ti) 

+  (g/VQ ) cos^Qdn ( ) ] At  (85) 

«ud  ( t i )  =  [ (n0gcosMg/V0cosV0) (ti) 

+  (gsinM0/V0cosY0) «n(ti) ]At  (86) 

«ud  (tx)  =  «ud  (ti)  =  iud  (ti)  =  0  (87) 

4  5  6 


Eqs  (84)  -  (86)  may  be  solved  to  obtain  fip(t^), 
6n(t^)  ,  and  6T(t^)in  terms  of  dud  ( t  ^ ) ,  dud  (t^),  and 
6ud  ^ i )  '  w^ich  are  estimated  directly  by  the 
filter-smoother.  The  results  are: 


i/i(ti)  =  (l/n0)  ( ~  ( VQsi  n  Mg/gAt )  4ud  ^  ( t^  ) 

+  (V0cosju0cosy0/gAt)  «ud^  (ti)  ]  (88) 

«n(ti)  =  (V0cos^0/gAt) dud^ (tx) 

+  (V0cosY0sin/u0/gAt)  «ud^  (ti)  (89) 

«T(ti)  =  (W/gAt)6ud  (tA)  +  |2[ (V0cos^0/gAt)6ud  (ti) 

+  (V0cosY0sin^0/gAt )  fiud  (t^  ]  (90) 


Eqs  (87)  -  (89)  may  be  used  to  estimate  the  control 
perturbation  inputs.  The  singularity  at  zero  nominal  normal 
acceleration  in  Eq  (87)  may  be  handled  computationally  by 
setting  6n(t^)  to  zero  for  cases  where  nQ  is  within  a  small 
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tolerance  of  zero.  This  assumes,  of  course,  that  sustained 
zero-g  flight  is  not  to  be  modelled. 

This  completes  the  development  of  the  algorithm  for 
trajectory  estimation  using  the  linearized  Kalman 
filter-smoother.  The  following  chapters  will  address 
details  of  the  actual  implementation  used,  and  the  results 
obtained . 
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Detailed  Analysis  Procedure 


3 . 1  Details  of  Implementation 

The  linearized  Kalman  filter-smoother  algorithm 
developed  in  Chapter  II  was  implemented  on  the  CDC  Cyber 
computer  at  the  Wrigh t-Pa tt er son  Air  Force  Base  Computer 
Center.  Other  programs  were  also  developed  or  modified  to 
support  the  filter-smoother.  These  include  the  author's 
three  degree-of-f reedom ,  force-equation  aircraft  trajectory 
program  (PMSIM) ,  previously  described  in  Section  1.1,  which 
was  modified  to  generate  nominal  trajectory  data,  "true" 
trajectories  which  incorporated  dynamics  driving  noise  but 
no  measurement  corruption  noise,  and  measurement  time 
histories  which  incorporated  both  types  of  noise.  Programs 
to  plot  various  data  as  functions  of  time  were  also  created. 
Data  which  could  be  plotted  included  the  nominal,  true, 
measured,  and  smoothed  trajectories,  the  difference  between 
the  smoothed  and  true  trajectories,  the  filter-smoother 
state  and  control  perturbations,  and  the  diagonal  elements 
of  the  covariances  computed  by  the  filter-smoother  and  the 
forward  filter.  Certain  of  the  plotting  programs  computed 
the  temporal  mean  and  standard  deviation  of  each  of  the 
variables  displayed,  using  the  equations: 
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Xi  “  N  Z^W 

k-1  1/2 


Provisions  were  also  made  for  successive  iterations 
of  the  filter-smoother  algorithm.  The  approach  taken  was  to 
use  the  results  of  each  filter-smoother  run  to  "correct"  the 
computed  nominal  trajectory  for  the  next  run.  In  order  to 
make  such  iterations  possible,  three  different  procedures 
for  generating  nominal  trajectories  were  implemented.  The 
first  of  these  was  to  generate  the  nominal  trajectory  using 
the  PMSIM  program,  with  control  input  functions  produced  by 
subroutines  within  PMSIM.  This  method  was  always  used  to 
generate  the  nominal  trajectory  for  the  first  run  of  a  set 
of  iterations.  It  was  also  used  to  generate  true  and 
measured  trajectories,  with  noise  corruption  added  at 
appropriate  points.  The  second  nominal  trajectory 
generation  method  was  to  use  the  filter-smoother  output  to 
set  the  initial  conditions  and  provide  the  control  input 
functions,  by  summing  the  preceding  nominal  control  input 
time  history  and  the  estimated  control  perturbations.  The 
PMSIM  program  was  then  used  to  generate  the  next  nominal 
trajectory.  This  technique  was  used  for  a  majority  of  the 
iterations  which  were  actually  performed.  An  alternative 


method  was  simply  to  use  the  smoothed  trajectory,  defined  as 
the  nominal  trajectories  of  both  states  and  controls  plus 
the  associated  perturbations  output  by  the  filter-smoother, 
as  the  nominal  trajectory  for  the  next  run,  and  provision 
was  also  made  for  use  of  this  technique. 

3 . 2  speci f ic  Trajectories  Used 

Three  different  trajectories  were  used  during  the 
evaluation  of  filter-smoother  performance.  These 
trajectories  were  designed  to  represent  plausible  aircraft 
mishap  scenarios.  The  various  measurement  models  used  with 
these  trajectories  are  described  in  Section  3.3.  Dynamics 
driving  noise  strength  and  measurement  corruption  noise 
values  used  in  these  models  are  noted  in  Sections  4.1  and 
4.2. 

The  first  trajectory,  hereafter  referred  to  as 
Trajectory  1,  was  used  for  the  initial  phase  of  the 
evaluation.  It  was  deliberately  designed  to  be  fairly 
"benign",  incorporating  no  roll  attitudes  or  flight  path 
angles  greater  than  45  deg.  It  basically  consisted  of  a 
roll  to  45  deg  roll  attitude,  with  a  time-varying  load 
factor  which  peaked  at  5.5,  followed  by  a  relaxation  of  load 
factor  to  0.1  and  a  descent  to  zero  altitude.  Constant 
thrust  was  maintained  throughout  this  trajectory.  Figure  2 
is  a  plot  of  the  true  states  and  control  input  functions  for 
this  trajectory,  with  a  representative  set  of  measurements 


also  shown.  (These  measurements  were  taken  using 
measurement  model  FS-1,  defined  in  Section  4.2,  which 
assumes  all  states  are  directly  measurable.  More  realistic 
measurement  models  were  used  later  in  the  study,  and  are 
defined  in  Sections  3.3  and  4.2.)  Figure  2,  along  with  all 
others  showing  trajectory  time  history  data,  may  be  found  in 
the  Appendix. 

Trajectory  2  was  a  more  aggressive  profile,  roughly 
simulating  a  tactical  bomb  run  with  a  recovery  attempt  which 
failed  to  prevent  descent  below  zero  altitude.  In  this 
scenario,  the  aircraft  started  out  in  level  flight  at  a 
fairly  low  altitude,  was  pulled  up  to  a  shallow  flight  path 
angle,  rolled  to  the  inverted  position,  allowed  to  decrease 
flight  path  angle  u^il  altitude  was  being  lost,  rolled  back 
upright,  and  then  a  pullout  was  initiated  which  was  unable 
to  prevent  zero  altitude  penetration.  Thrust  was  adjusted 
to  maintain  a  relatively  constant  velocity  during  the 
maneuver.  Figure  3  displays  the  true  states  and  control 
input  functions  for  this  trajectory.  Representative 
measurements,  again  simulated  using  measurement  model  FS-1, 
are  also  shown  in  the  figure. 

Trajectory  3  was  the  most  severe  profile  used  in  the 
evaluation,  and  was  deliberately  intended  to  test  the 
behavior  of  the  algorithm  in  the  neighborhood  of  singular 
points  in  the  linearized  model.  This  flight  path  began  in 
level  flight.  The  aircraft  was  then  pulled  up  through  the 


vertical,  and  the  pull  was  continued  until  it  was  flying 
upside  down  on  a  heading  opposite  the  original  one.  A 
series  of  rolls  was  then  begun,  and  continued  until  the 
aircraft  descended  below  zero  altitude,  which  occurred  after 
the  third  roll  was  complete.  Thrust  was  held  constant 
throughout  the  maneuver.  Figure  4  plots  the  true  states  and 
control  inputs  for  this  trajectory,  as  well  as 
representative  measurements  from  measurement  model  FS-1.  In 
this  figure,  the  reader  will  note  what  appears  to  be  a 
change  in  the  noise  corruption  magnitude  in  normal 
acceleration  during  the  middle  portion  of  the  trajectory. 
This  is  due  to  the  simulated  aircraft  reaching  its 
angle-of-attack  limit  during  this  portion  of  the  trajectory, 
and  not  to  any  real  change  in  the  noise  corruption 
ampl i tude . 

The  same  aircraft  model  (the  PMSIM  program,  ref. 
Ruley,  1987b)  was  used  to  generate  all  three  trajectories. 
Data  used  for  this  model  are  representative  of  a  modern 
twin-engine  tactical  fighter  in  an  air-to-ground  attack 
configuration.  Due  to  the  complexity  of  the  model  and  the 
fact  that  it  was  not  an  integral  part  of  the  filter-smoother 
algorithm,  it  will  not  be  further  discussed  in  this  report. 

3 . 3  Measurement  Models 

Three  mathematical  models  were  developed  to  simulate 
different  measurement  devices  during  the  study  of 
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filter-smoother  performance.  The  first  of  these  was  a 
full-state  model,  where  measurements  of  all  states  were 
assumed  to  be  directly  measurable.  This  is  probably  not 
representative  of  any  actual  device,  but  was  selected  by  the 
author  as  an  easily  programmed  first  case.  This  model  was 
defined  by  the  following  equations: 

z(ti)  =  x(ti)  +  v(tx) 

H(t1)  =  I 

where  the  error  characteristics  of  the  measurement 
corruption  noise  vector  are  defined  as  in  Eqs  (30)  and  (31). 
The  measurement  error  covariance  magnitudes  were  set  on  a 
case-by-case  basis  and  are  tabulated  in  Sections  4.1  and 

4.2. 

The  second  model  was  created  to  simulate  a 
ground-based  radar  measuring  aircraft  position  only.  The 
equations  used  for  this  model  were: 

z:  =  R  =  (h2  +  y2  +  x2) 1/2  +  vR  (95) 

z2  =  •  =  sin-1(h/R)  +  v  (96) 

z 3  a  6  -  tan-1 (y/X )  +  vfl  (97) 

where : 

R  is  radar  range 
•  is  elevation  angle 


(93) 

(94) 
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8  is  azimuth  angle 


and  the  measurement  noise  statistics  and  covariance  are 
defined  as  they  were  for  the  previous  model.  Again, 
measurement  corruption  noise  covariance  values  used  with 
this  model  are  tabulated  in  Sections  4.1  and  4.2  on  a 
case-by-case  basis. 

From  these  equations,  the  components  of  the 
measurement  matrix  (see  Eqs  (29)  and  (34))  are  given  by: 


”14  -  U  "  h/R 


h15  '  i  ■  y/R 


h16  '  H  *  X/R 


h24  =  Ik  =  [R/ (R~h) i 1/2 (1/R) 


[R/ (R-h) ] 1/2 (-hY/R3) 


[R/ (R-h) ] 1/2 (-hX/R3) 


[X/  (X2  +  Y2)  ] 
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(104) 


(105) 
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h36  '  If  -  !-*'U2  *  »2)) 


(106) 


where  the  symbols  are  as  defined  above  and  in  Chapter  II. 

All  other  elements  of  the  measurement  matrix  are  zero. 

The  reader  will  note  that  the  measurement  matrix 
defined  above  has  elements  which  are  singular  at  zero  range 
and  where  range  is  equal  to  the  altitude  of  the  aircraft. 
These  singularities  make  physical  sense.  At  zero  range, 
elevation  angle  and  azimuth  angle  are  undefined,  and 
therefore  the  change  in  these  quantities  with  position  is 
also  undefined.  Further,  at  zero  range  the  Cartesian 
position  coordinates  are  also  zero,  and  the  change  in  range 
with  position  coordinates  becomes  undefined,  as  seen  from 
the  form  of  Eqs  (98)  -  (100).  When  range  equals  altitude, 
the  aircraft  must  be  directly  over  the  radar,  i.e.  at  an 

i 

elevation  angle  of  90  deg.  For  this  condition  the  azimuth 

angle  becomes  undefined,  and  the  Cartesian  coordinates  X  and 

Y  become  zero.  Therefore,  the  change  in  azimuth  angle  with 
I 

i  Cartesian  position  coordinates  becomes  undefined,  and  Eqs 

> 

j  (101)  -  (103)  show  that  the  change  in  elevation  with  these 

!  position  coordinates  is  also  undefined.  The  change  in  range 

I 

with  altitude  becomes  unity,  since  range  equals  altitude, 

i 

I  and  the  changes  in  range  with  X  and  Y  become  zero,  as  seen 

1  in  Eqs  ( 99 )  and  ( 100 )  . 

I 


Computationally,  this  problem  was  solved  in  the 
following  manner.  The  magnitudes  of  range  and  the 
difference  of  range  and  altitude  were  computed  along  with 
the  elements  of  the  measurement  matrix.  If  the  range  R  was 
less  than  a  small  tolerance  value  (0.0001  in  the 
implementation  used),  all  elements  of  the  measurement  matrix 
were  set  to  zero.  If  the  range  was  nonzero  but  the 
magnitude  of  the  difference  of  range  and  altitude  was  less 
than  the  tolerance,  then  the  (1,4)  element  of  the 
measurement  matrix  was  set  to  unity  and  all  other  matrix 
elements  were  set  to  zero. 

The  third  measurement  model  developed  was  a 
modification  of  the  radar  position  model,  in  which  range 
rate  information  was  also  assumed  to  be  available  (perhaps 
from  a  Doppler  radar) .  The  additional  equations  required  to 
implement  this  feature  were: 

(1/R)  (hh  +  YY  +  XX)  (107) 

R/V  (108) 

(V/R) [hcosY  -  (YsinX  +  XcosX) sinY]  (109) 

(V/R)  [  ( Ycos  X  -  XsinX)cos>)  (110) 

(h/R)  -  (hR/R2)  (111) 


h45  =  Iy  =  (Y/R)  "  (Y*/r2> 


h46  =  ||  =  (X/R)  -  (XR/R2) 


(112) 


(113) 


where  all  variables  remain  defined  as  above,  and  the 
measurement  noise  statistics  and  covariance  are  defined  as 
they  were  for  both  previous  models.  Measurement  corruption 
noise  covariance  values  which  were  used  are  again  tabulated 
in  Sections  4.1  and  4.2  on  a  case-by-case  basis. 

These  equations  were  used  together  with  Eqs 
(95)  -  (106)  to  implement  the  radar  model  with  range  rate. 
Again,  singularities  existed  at  zero  range.  Physically, 
these  corresponded  to  the  inability  of  the  radar  to  resolve 
position  coordinates  at  zero  range,  as  discussed  above  for 
the  previous  model.  Computationally,  they  were  handled  in 
the  same  manner  as  for  the  radar  without  range  rate. 


3 . 4  Chapter  Summary 

This  chapter  discusses  details  of  the  implementation 
of  the  filter-smoother  algorithm,  describes  three 
trajectories  used  for  algorithm  performance  analysis,  and 
discusses  the  three  measurement  models  used  in  this 
analysis.  Implementation  details  given  include  descriptions 
of  the  process  used  to  generate  nominal,  "true”,  and 
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measured  trajectories,  as  well  as  procedures  used  for 
successive  iterations  of  the  filter-smoother  algorithm. 
Discussion  of  the  trajectories  used  includes  a  description 
of  the  rationale  behind  thrir  choice,  and  a  description  of 
the  control  inputs  and  resulting  aircraft  motions  for  each 
one.  The  measurement  models  are  fully  defined 
mathematically,  and  both  the  physical  meanings  of 
singularities  and  computational  procedures  for  handling  them 
are  given. 
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IV.  Performance  Evaluation 


The  evaluation  of  filter-smoother  algorithm 
performance  included  three  detailed  studies.  The  first  of 
these,  a  robustness  study,  was  intended  to  investigate  how 
well  the  algorithm  would  perform  when  the  filter-smoother's 
assumed  dynamics  driving  noise  strength  and  measurement 
corruption  noise  covariance  were  perturbed  away  from  the 
values  used  to  generate  the  true  trajectory.  The  idea 
behind  this  study  was  to  determine  how  closely  the  true  and 
assumed  noise  magnitudes  needed  to  be  matched  to  obtain  good 
performance.  The  second  study,  a  measurement  precision 
effects  evaluation,  was  meant  to  determine  the  effect  on  the 
algorithm  of  changes  in  the  actual  measurement  corruption 
noise  covariances,  which  remained  matched  to  the  values 
assumed  by  the  filter-smoother.  This  corresponded 
physically  to  the  use  of  various  measurement  devices  of 
differing  accuracy.  Both  of  these  studies  considered  only 
one  iteration  of  the  algorithm.  The  third  part  of  the 
evaluation  was  an  investigation  of  the  effects  of  various 
schemes  for  successive  filter-smoother  iterations,  which 
were  anticipated  to  improve  the  correspondence  between  the 
smoothed  and  true  trajectories. 
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4 . 1  Robustness  Study 

The  purpose  of  this  study  was  to  examine  the 
sensitivity  of  the  filter-smoother  to  perturbations  of  the 
components  of  the  dynamics  driving  noise  strength  and 
measurement  corruption  noise  covariance  matrices  assumed  by 
the  algorithm,  while  keeping  the  corresponding  variances  in 
the  "true"  trajectory  generation  program  constant.  The 
intention  was  to  see  how  closely  the  true  and  assumed  noise 
magnitudes  needed  to  be  matched  for  good  performance.  The 
approach  taken  was  to  use  the  filter-smoother  to  generate  a 
baseline  case  and  then  make  additional  runs,  perturbing  the 
elements  of  the  noise  strength  and  covariance  matrices  one 
at  a  time.  One  iteration  of  the  algorithm  was  performed  for 
each  case. 

For  a  baseline  case.  Trajectory  1  was  used,  with  the 
full-state  measurement  model  and  the  diagonal  elements  of 
the  filter-smoother  assumed  dynamics  driving  noise  strength 
and  measurement  noise  covariance  matrices  given  in  Tables  1 
and  2.  These  values  were  not  selected  in  order  to  represent 
any  particular  physical  device.  They  were  chosen  to  give 
"noticeable"  noise  corruption  without  grossly  perturbing  the 
inputs  and  measurements. 

All  off-diagonal  elements  of  the  dynamics  driving 
noise  strength  and  measurement  corruption  noise  covariance 
matrices  were  assumed  to  be  zero.  Physically,  this  meant 
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Element 


Value 

Interpretation 

5.0  (deg^/sec) 

noise  in  roll  attitude 

0 . 2  (g2/sec) 

noise  in  normal  acceleration 

100.  (lb1/sec) 

noise  in  thrust 

1.  (ft2/secs) 

noise  in  Z-wind  component 

1.  (ft2/sec3) 

noise  in  Y-wind  component 

1.  (ft2/sec3) 

noise  in  X-wind  component 

Table  2 

Measurement  Noise  Covariance  for  Baseline  Case 


Element 


Value 

Interpretation 

10.  (ft2/sec2) 

noise  in  velocity 

5.  (deg2) 

noise  in  flight  path  angle 

5.  (deq2) 

noise  in  heading  angle 

100.  (ft2) 

noise  in  altitude 

1000.  (ft2) 

noise  in  Y-coordinate 

1000.  (ftz) 

noise  in  X-coordinate 

that  the  various  noise  components  were  assumed  to  be 
uncorrelated  with  each  other. 

Nominal,  true,  and  measured  trajectories  were 
generated  for  this  baseline  case.  Control  inputs  which 
produced  Trajectory  1  were  first  developed,  and  the  results 
were  used  as  the  nominal  trajectory.  The  measured  and  true 
trajectories  were  then  produced  by  artificially  noise 
corrupting  the  control  inputs  and  (for  the  measured 
trajectory)  the  output.  This  noise  corruption  was 
accomplished  in  the  computer  software  by  adding 
computer-generated  Gaussian-dist ributed  random  noise 
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sequences  to  the  inputs  and  measurements.  The  variances  of 
the  noise  sequences  were  adjusted  so  that  the  noise  strength 
corresponded  to  the  strength  assumed  by  the  filter-smoother, 
with  the  exception  of  the  wind  noise  components.  For 
simplicity,  wind  noise  was  not  included  in  the  trajectory 
generation  program.  Accordingly,  a  unit  value  was  chosen 
for  wind  noise  in  the  filter-smoother  dynamics  driving  noise 
strength  matrix  because  it  was  considered  to  be  sufficiently 
small  in  comparison  to  the  others  to  avoid  an  adverse  impact 
on  the  results.  This  hypothesis  was  tested  by  including 
variations  of  the  assumed  wind  noise  strengths  in  the 
evaluation. 

With  the  nominal,  true,  and  measured  trajectories 
complete,  one  iteration  of  the  filter-smoother  algorithm  was 
performed  for  the  baseline  case.  The  results  of  this  run 
formed  the  standard  of  comparison  for  the  results  of 
succeeding  cases.  Figure  5  shows  a  comparison  of  the  true 
trajectory  and  the  resulting  smoothed  trajectory,  and  Figure 
6  shows  the  differences  between  the  two.  As  stated  in 
Section  3.2,  figures  giving  time  histories  of  trajectory 
data  may  be  found  in  the  Appendix.  The  temporal  mean  and 
standard  deviation  of  the  differences  between  the  smoothed 
and  true  trajectories  are  given  in  Table  3,  where  m  and  <r 
represent  these  two  quantities,  respectively. 

As  stated  above,  the  robustness  study  procedure  was 
to  use  the  same  nominal,  true,  and  measured  trajectories  for 
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Table  3 

Means  and  Standard  Deviations  of  Errors  for  Baseline  Case 


Variable 

Value 

V 

V 

2.297 

cr 

9.937 

* 

m 

0.7045 

cr 

0.5005 

“Y 

m 

0.6250 

A. 

Cr 

0.4510 

m 

-1.476 

h 

cr 

10.44 

m 

10.24 

T 

cr 

34.27 

m 

-6.047 

X 

cr . 

33.04 

m 

0.05888 

M 

cr 

2.084 

m 

0.606962 

n 

cr 

0.5187 

m 

31.59 

T 

Or 

1575  . 

each  case,  but  to  perturb  the  elements  of  the  noise  strength 
matrices  in  the  filter-smoother  individually  in  order  to 
determine  the  resulting  effects.  This  perturbation  was 
accomplished  by  either  multiplying  or  dividing  the  affected 
element  of  the  noise  strength  matrix  by  a  factor  of  50, 
which  was  selected  arbitrarily  as  a  significant  but  not 
unreasonably  large  change.  The  results  are  given  in  Tables 
4  -  7,  in  terms  of  the  temporal  mean  and  standard  deviation 
of  the  errors  committed  by  the  filter-smoother  algorithm. 

To  generate  Tables  4  and  5,  the  elements  of  the 
measurement  corruption  noise  covariance  matrix  were 
individually  increased  and  decreased,  respectively. 
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Table  4 


Errors  Committed  by  Filter-Smoother  with  Increased 


Measurement  Corruption  Noise  Covariance 


Matrix  Element 
Increased  (1,1) 

— 

(2,2) 

(3,3) 

(4,4) 

(5,5) 

(6,6) 

Varxa 

ble 

V 

tn 

cr 

3.691 

10.59 

2.296 

9.937 

2.296 

9.938 

0.146 

5.641 

1.038 

9.313 

0.534 

9.396 

X 

m 

or 

0.705 

0.500 

0 .705 
0.500 

0.705 

0.500 

0.702 

0.508 

0.704 

0.500 

0.704 

0.500 

X 

m 

Cr 

0.626 

0.451 

0.625 

0.451 

0.625 

0.451 

0.626 

0.451 

0.625 

0.441 

0.623 

0.458 

h 

m 

O' 

-1.346 

7.606 

-1.513 

10.53 

-1.515 

10.51 

-4.404 

101.9 

-1.009 

8.373 

-0.871 

8.169 

Y 

m 

<T 

10  .25 
36.13 

10.25 

34.29 

10.23 

34.34 

9.346 

18.11 

-46.82 

88.52 

9.186 

16.63 

X 

m 

cr 

-2.325 

36.47 

-6.069 
•  33.07 

-6.041 

33.04 

0.299 

25.18 

-1.  224 
12.48 

-77.99 

56.25 

M 

m 

cr 

0.065 

2.030 

0.059 

2.084 

0.060 

2.081 

0.080 

1.991 

0.028 

2.152 

0.058 

1.996 

n 

m 

O' 

0.016 

0.467 

0.007 

0.519 

0.007 

0.519 

0.006 

0.444 

0.020 

0.496 

-0.001 

0.455 

T 

m 

JZ _ 

9.343 

1201. 

31.56 
157  8  . 

30.59 
1580  . 

6.874 

756.0 

-0.707 

1603. 

4.181 
58  9  .  1 

Tables  6  and  7  show  the  results  of  corresponding  adjustments 
to  the  values  of  the  dynamics  driving  noise  strength  matrix. 
Admittedly,  cases  where  the  values  were  reduced  were  not 
advisable  choices  for  noise  strengths,  as  it  is  never  good 
practice  to  underestimate  their  magnitude  intentionally. 
However,  in  actual  practice  the  noise  strengths  may  not  be 
precisely  known,  so  underestimation  of  elements  of  these 
matrices  is  possible.  The  additional  effort  was  also 
justifiable  for  the  sake  of  completeness. 

The  results  in  Tables  4-7  show  principally  that 


the  algorithm  is  not  highly  sensitive  to  changes  in 


Table  5 


Errors  Committed  by  Filter-Smoother  with  Decreased 
Measurement  Corruption  Noise  Covariance 


2.250 

9.865 


0.705 

0.501 


0.625 

0.451 


0.971 

10.21 


10.38 

34.03 


2.409 

10.24 


0.705 

0.500 


0.625 

0.451 


0.062 

2.269 


0.007 

0.525 


2.485 

10.77 

2.814 

9.443 

0.704 

0.704 

0.502 

0.502 

0.625 

0.627 

0.457 

0.442 

-1.579 

-1.242 

15.70 

15.86 

10.01 

9.909 

26.35 

69.64 

-9.429 

2.005 

53.49 

2  2.60 

0.190 

-0.003 

3.826 

3.921 

0.015 

0.018 

0.783 

0.675 

-184 . 9 
5671  . 

individual  elements  of  the  noise  strength  and  covariance 
matrices.  This  is  particularly  true  of  the  states,  which 
tend  to  be  less  sensitive  to  the  perturbations  than  do  the 
control  inputs.  In  fact,  the  results  show  that  artificially 
increasing  elements  of  the  measurement  corruption  noise 
covariance  matrix  can  help  reduce  the  magnitude  of  control 
input  "spikes"  produced  by  the  filter-smoother  (see  the 
thrust  trace  of  Figure  5  for  an  example) .  This 
characteristic  was  exploited  later,  during  the  iteration 
study,  which  will  be  described  in  detail  in  Section  4.3. 
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Table  6 

Errors  Committed  by  Filter-Smoother  with  Increased 
Dynamics  Driving  Noise  Strength 


Matrix  Element 
Increased _ (1,1 ) 


Variable 


0. 

705 

0. 

541 

0. 

625 

0. 

493 

-10 

.85 

59 

.12 

20 

.76 

-1.090 

33.12 


0.087 

7.247 


0.004 

0.496 


11.82 


0.703 

0.502 


0.625 


■0.900 

14.44 


10.17 

34.25 


2.212 

30.44 


0.126 

2.122 


■0.014 

2.522 


■91.63 
6288  . 


0.704 

0.500 


0.625 

0.451 


10.35 


10.22 

33.63 


■5.813 
32.  25 


0.060 

2.080 


0.007 

0.514 


7.498 
1544  . 


0.417 

5.784 


0.710 

0.504 


0.625 

0.452 


-1.069 

7.573 


9.808 

24.80 


-1.043 
1 


0.088 

2.015 


0.006 
0 .440 


12.91 

913.8 


1.649 

9.676 

0.571 

9.386 

0.704 

0.704 

0.500 

0.500 

0.623 

0.626 

0.450 

0.453 

-1.271 

-1.045 

9.780 

9.035 

10.00 

9.689 

28.71 

-3.981 

0.078 

25.22 

20.79 

0.068 

0.068 

2.066 

2.033 

ipm 

0.007 

0.468 

Despite  the  fact  that  the  algorithm  was  shown  not  to 
be  highly  sensitive  to  perturbations  in  the  assumed  noise 
strength  and  covariance  matrices,  these  changes  did  have 
measurable  effects.  Some  general  trends  were  also 
discernible  from  the  results  of  these  perturbations,  and 
will  be  described  below.  The  reader  is  cautioned  that  some 
of  the  observed  trends  might  have  been  dependent  upon  the 
geometry  of  the  trajectory  used  for  this  evaluation,  the 
relative  magnitudes  of  the  noise  strengths  and  covariances 
chosen  for  the  baseline  case,  and  the  full-state  measurement 


model 


Table  7 

Errors  Committed  by  Filter-Smoother  with  Decreased 


Dynamics  Driving  Noise 


Matrix  Element 
Decreased _ 

Variable  I 


2  ,  390 
10.08 
0.705 
0.499 
0.624 
0.452 
-1.001 
10.04 
8.800 
32.03 
-6.553 
33.10 
0.077 
1.890 
-0. 004 
0.521 
17.25 
1921. 


(2,2) 

2.226 
9.772 
0.705 
0.501 
0.624 
0.455 
-1.849 
11.74 
9.746 
28.40 
■10.46 
38.14 
0.008 
2.178 
0.024 
0,432 
17.62 
399. 5 


(3,3) 

2  .  295 
9.938 
0.705 
0.500 
0.625 
0.451 
-1.476 
10.44 
10.23 
34.28 
■6 .044 
33.03 
0.059 
2.083 
0.007 
0.579 
32.09 
1576. 


(4,4) 

2.380 
10.14 
0.704 
0.500 
0.625 
0.451 
-1.531 
10.64 
10  .  25 
34.69 
-6.209 
33.35 
0.058 
2.088 
0.007 
0.523 
32.51 
1607. 


(5,5) 

2.311 
9.947 
0 .705 
0.500 
0.625 
0.451 
-1.478 
10.44 
10  .  26 
34.52 
-6.0  57 
33.25 
0.058 
2.084 
0.007 
0.519 
31.94 
1580. 


(6,6) 

2.412 
10.00 
0.705 
0.500 
0.625 
0.451 
•1 .507 
10.55 
10.29 
34.73 
-6.382 
33.58 
0.058 
2.087 
0.007 
0.522 
33.23 
1616. 


With  these  qualifying  statements  in  mind,  the 
observed  trends  will  now  be  discussed.  Generally  speaking, 
an  increase  in  the  assumed  measurement  noise  variance  value 
for  one  state  resulted  in  a  less  accurate  match  between  the 
filter-smoother  results  and  the  true  trajectory  for  that 
state,  but  might  improve  the  match  for  other  states. 
Conversely,  decreasing  the  assumed  measurement  corruption 
noise  variance  for  a  given  state  often  resulted  in  a  better 
match  for  that  state,  but  this  improvement  was  at  the 
expense  of  a  poorer  match  for  some  of  the  other  states. 
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These  effects  may  be  seen  by  comparing  the  results  in  Table 
3  to  those  in  Tables  4  and  5. 

Considering  now  the  effects  of  perturbations  in  the 
values  of  the  dynamics  driving  noise  strength  matrix,  the 
results  of  Tables  6  and  7  show  that  the  noise  strength 
elements  corresponding  to  the  control  inputs  had  different 
effects  from  those  corresponding  to  wind  noise.  Increasing 
the  assumed  magnitude  of  control  input  noise  could  degrade 
the  match  between  the  filter-smoother  output  and  the  true 
trajectory,  but  only  slightly  in  the  case  of  the  states.  In 
particular,  increasing  the  assumed  driving  noise  for  load 
factor  apparently  caused  significant  errors  in  the  thrust 
match.  Decreasing  the  assumed  control  input  noise  had  a 
lesser  effect,  particularly  on  the  states,  but  a  decrease  in 
the  assumed  value  of  load  factor  driving  noise  strength 
apparently  improved  the  thrust  match.  By  contrast, 
increasing  the  assumed  values  for  wind  noise  strength  tended 
to  improve  the  match  between  the  filter-smoother  output  and 
the  true  trajectory,  because  the  algorithm  put  less  weight 
on  its  internal  model  and  more  on  the  measurements  in  such 
cases.  Reducing  these  values  had  little  effect.  Again,  it 
should  be  stressed  that  all  these  effects  were  of  small 
magnitude,  and  may  well  have  been  dependent  upon  trajectory 
geometry  and  the  measurement  models  used. 

In  summary,  the  robustness  study  showed  that  the 
filter-smoother  results  were  not  greatly  perturbed  by 
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relatively  large  changes  in  individual  elements  of  the 
dynamics  driving  noise  strength  and  measurement  corruption 
noise  covariance  matrices.  However,  artificially  increasing 
elements  of  the  measurement  noise  covariance  matrix  was 
shown  to  be  a  viable  method  for  reducing  unrealistic 
transients  in  the  smoothed  estimates  of  the  control  inputs. 


4.2  Measurement  Precision  Evaluation 


The  next  step  in  the  performance  evaluation  was  a 
study  to  determine  how  filter-smoother  performance  varied 
with  measurement  precision.  This  differed  from  the 
robustness  study  in  that  the  elements  of  *-he  dynamics 
driving  noise  strength  and  measurement  corruption  noise 
covariance  matrices  in  the  filter-smoother  were  always 
matched  to  the  variances  of  the  noise  corruption  used  to 
generate  the  true  and  measured  trajectories.  While 
maintaining  this  match,  the  measurement  corruption  noise 
covariance  was  varied  from  run  to  run  in  order  to  represent 
more  or  less  precise  measurement  devices.  As  in  the 
robustness  study,  only  one  iteration  was  performed  for  each 


The  evaluation  included  all  three  trajectories  and 
all  three  measurement  models  discussed  in  Chapter  III.  One 
set  of  dynamics  driving  noise  strengths  was  used  for  each 
trajectory,  and  two  sets  of  measurement  corruption  noise 
covariances  were  used  for  each  measurement  model.  These 
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values  are  given  in  Tables  8  and  9,  where  the  following 
symbols  are  used  to  designate  the  various  measurement 
models:  FS  for  full  state,  RP  for  radar  with  position 

measurements  only,  and  RR  for  radar  with  position  and  range 
rate  data. 

The  rationale  behind  the  choices  made  for  dynamics 
driving  noise  strength  and  measurement  corruption  noise 
covariance  matrices  was  as  follows.  For  simplicity,  the 


Table  8 


Dynamics  Driving  Noise  Strengths 


Matrix 

Element 


Trajectory 

1 

2 

3 


Matrix 
Elemen  t 


Measurement 

Model 


FS-1 
FS-  2 
RP- 1 
RP-  2 
RR- 1 
RR-  2 


for  Measurement  Precision  Study 


(3,3) 


100. 

10000. 

10000. 


0.01 


(1,1) 


(5,5)  |  (6,6) 


10. 
10. 
1000  . 
10000. 
1000  . 
10000. 


5. 

0.  25 

5. 

0  .  25 

5  . 

0.  25 


5. 

0.25 

5. 

0.  25 
5. 

0.  25 


1000.  1000. 

100.  100. 
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dynamics  driving  noise  for  Trajectory  1  remained  as  it  had 
been  for  the  robustness  study.  For  Trajectories  2  and  3, 
noise  corruption  of  load  factor  was  reduced  and  that  of 
thrust  was  increased,  as  shown  in  Table  8.  This  choice  was 
made  because  the  original  level  of  load  factor  noise 
corruption  caused  significant  mismatches  between  the  nominal 
and  true  tra jector ies ,  while  the  original  level  of  thrust 
noise  corruption  was  barely  noticeable  in  comparison  to  the 
thrust  magnitude.  Turning  to  measurement  corruption  noise, 
the  original  full  state  model  from  the  robustness  study  was 
retained  as  model  FS-1.  Values  for  model  FS-2  were  selected 
in  order  to  improve  the  accuracy  in  all  states  except 
velocity  and  altitude,  which  were  already  being  measured 
with  little  noticeable  noise  corruption.  The  values  for 
radar  model  RP-1  were  chosen  to  correspond  roughly  to  the 
FS-1  values,  and  those  for  RP-2  were  chosen  in  order  to 
explore  less  accurate  range  measurements  combined  with  more 
accurate  angular  measurements.  This  was  of  interest  because 
of  the  uncertainty  in  position  introduced  by  large  angular 
measurement  uncertainties  at  long  ranges.  Finally,  radar 
models  RR-1  and  RR-2  were  developed  simply  by  adding  range 
rate  measurement  capability  to  models  RP-1  and  RP-2,  with 
the  same  amount  of  corrupting  noise  in  each  case.  No 
attempt  was  made  to  choose  any  of  these  sets  of  measurement 
noise  covariance  values  based  upon  actual  measurement  device 
capabilities,  as  the  intention  of  the  study  was  to  explore 


the  theoretical  performance  of  the  algorithm,  and  not  of  the 
measurement  system. 

Results  obtained  included  plots  of  the  smoothed  and 
true  trajectories,  the  errors  committed  by  the  filter- 
smoother  algorithm,  and  the  diagonal  elements  of  the 
filter-smoother  computed  covariance,  all  as  functions  of 
time.  Numerical  values  for  the  temporal  means  and  standard 
deviations  of  the  errors  and  diagonal  covariance  elements 
were  also  obtained.  These  values  are  recorded  in  Tables 
10  -  15,  where  the  square  roots  of  the  covariance  statistics 
have  been  taken  to  provide  numbers  which  correspond  more 
directly  with  the  error  magnitudes  than  the  variances 
themselves  would. 

Figures  7-12  are  samples  of  the  graphical  output 
obtained.  Figures  7-9  are  plots  of  the  errors  committed 
by  the  filter-smoother  algorithm  for  Trajectory  2  and  a 
selection  of  measuring  devices  (FS-1,  RP-2,  and  RR-2). 
Figures  10  -  12  are  plots  of  the  diagonal  terms  of  the 
corresponding  computed  filter-smoother  covariances.  These 
cases  were  chosen  from  the  full  set  to  present  typical 
results  to  the  reader,  without  overloading  him  with 
graphical  data.  As  stated  in  Section  3.2,  these  figures  and 
other  time  history  data  may  be  found  in  the  Appendix. 

Trends  which  were  observed  in  the  results  of  this 
study  will  now  be  discussed.  Comparing  Figures  7  -  9 ,  we 
see  that  for  the  chosen  magnitudes  of  measurement  corruption 
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Table  10 


Errors  Committed  by  Filter-Smoother  with  Various 


Measurement  Devices  --  Trajectory  1 


— 

m 

RP-1 

RP-2 

“ 

RR-1 

RR-2 

Variable 

V 

m 

2.297 

2.  248 

5.525 

-0.508 

4.607 

or 

9.937 

9.958 

|  1 

10.57 

5.983 

10.28 

X 

m 

0.704 

0 . 704 

0.706 

0.707 

0.710 

0.704 

or 

0 . 500 

0.502 

0.511 

0.509 

0.508 

0.512 

m 

0.625 

0.625 

0.622 

0.620 

0.624 

0.623 

ddl 

er 

0.451 

0.453 

0.462 

0.462 

0.463 

0.459 

u 

91.16 

77.06 

142.3 

82.31 

75.47 

48.59 

11  1 .  2 

58.17 

v 

m 

10.  24 

3.941 

20.32 

51.33 

14 .97 

er 

34.27 

20.  23 

da 

29.66 

42.00 

23.56 

v 

-6.047 

0.687 

-46.56 

2.906 

-58.34 

A 

m 

33.04 

2  2.80 

49.77 

68.97 

50.47 

m 

0.059 

0.088 

0.0  04 

0.009 

0.087 

0.158 

M 

er 

2.084 

2.109 

1 .866 

1.942 

1.975 

2.104 

m 

0.007 

-0.009 

-0.015 

-0.010 

-0.007 

-0.014 

n 

or 

0.519 

0.569 

0.426 

0.426 

0.428 

0.424 

T 

m 

31.59 

-6.594 

-5.270 

-12.15 

-2.577 

emu 

<y 

157  5  . 

2302  . 

194.7 

307.3 

224.7 

■Usl 

noise,  the  full-state  measurement  device  caused  the 
filter-smoother  to  commit  smaller  errors  than  did  either 
radar.  This  makes  physical  sense,  as  more  measurements  were 
available  when  the  full-state  device  was  used. 

It  is  also  noted  that  the  magnitude  of  the  errors 
committed  when  radar  was  used  tended  to  increase  with  time, 
reaching  a  maximum  at  or  near  the  end  of  the  trajectory. 

This  also  makes  physical  sense,  as  the  magnitude  of  the 
noise  corruption  in  radar  azimuth  and  elevation  angles  was 
considered  to  be  time-invariant.  Thus  increasing  radar 
ranges  would  tend  to  increase  errors  committed  in  the 


Table  11 


Errors  Committed  by  Filter-Smoother  with  Various 
Measurement  Devices  --  Trajectory  2 


— 

FS-2 

m 

■■n 

mm 

mm 

variable 

V 

m 

-0.209 

-0.116 

-2.165 

B 

-2.001 

-1.753 

V 

0.486 

0.515 

6.082 

BbeU 

5.750 

2.158 

* 

m 

0.001 

0.002 

0.025 

0.013 

0.012 

or 

0.124 

0.123 

0.102 

0.107 

nssfl 

0.109 

■PM 

m 

-0. 004 

-0.008 

-0.015 

-0.016 

-0.016 

-0.016 

mil 

cr 

0.076 

0.086 

0.080 

0.081 

0.077 

0.087 

u 

m 

-6.139 

-6.272 

22.88 

1  .  265 

20.82 

0 r 

5.397 

4.497 

127.5 

49.81 

120.7 

■lira 

v 

m 

0.949 

-0.138 

-31.89 

■ 

-30.95 

cr 

4.653 

2.647 

32.65 

■HBB 

29.99 

bub 

v 

m 

-4.938 

-0.223 

■ 

-17.83 

Bumi 

-16.91 

A 

cr 

37.44 

18.09 

Wkmwm 

38 . 50 

■ 

27.43 

m 

0.064 

-0.009 

-0.116 

-0.  244 

-0.089 

-0.  130 

M 

cr 

2.237 

2.218 

2.377 

2.268 

2.406 

2.329 

n 

m 

0.012 

0.007 

-0.004 

-0.004 

-0.003 

-0.004 

cr 

0.117 

0.114 

0.127 

0.118 

0.125 

0.119 

-r* 

m 

11.37 

-1.185 

-32.18 

-34.40 

RKU 

-36.25 

1 

o 

180.6 

175.1 

300.2 

210.3 

246.6 

Cartesian  coordinates  of  aircraft  position,  and  therefore 
a] so  in  velocity.  We  note  that  the  radar  range  was 
increasing  at  the  end  of  the  time  interval  for  Trajectory  2, 
reaching  its  maximum  at  the  final  time,  and  therefore  the 
observed  behavior  is  to  be  expected.  Turning  to  Figures 
10  -  12,  we  see  that  the  computed  covariance  also  tended  to 
predict  this  behavior  correctly  for  radar  measurements. 

We  also  note  that  the  full-state  measurement  device 
covariance  displayed  a  final,  and  sometimes  an  initial, 
transient.  These  are  characteristic  of  the  filter-smoother 
algorithm,  and  come  about  because  the  algorithm  includes 
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Table  12 

Errors  Committed  by  Filter-Smoother  with  Various 


Measurement  Devices  —  Trajectory  3 


Measurement 

Device 

FS-1 

FS-2 

RP-1 

RP-2 

RR-1 

RR-2 

Variable 

V  ” 

-1.285 

-1.958 

5.407 

0.454 

5.292 

0.029 

1.639 

3.052 

6.  251 

1.692 

6.412 

2.176 

y  in 

*  or 

-0.155 

-0.157 

-0.171 

-0.158 

-0.170 

-0.157 

0.175 

0.212 

0.183 

0.176 

0.187 

0.176 

X  m 

-5.866 

-5.071 

-5.484 

-4 .399 

-5.489 

-4.400 

A  cr 

14.31 

17.00 

10.55 

11.16 

10.54 

11.14 

h  m 

-1.866 

-1.255 

-1.619 

-24.46 

2.930 

-23.01 

Cr 

6 .269 

17.80 

84.60 

19.77 

87.19 

20.09 

v  m 

11.27 

18.77 

30.89 

11.82 

25.23 

7.605 

<r 

150.9 

204.6 

50.62 

46.72 

39.67 

37.04 

w  m 

-12.03 

-12.82 

-27.62 

0.429 

-28 .18 

-2.648 

A 

a 

88.44 

123.0 

80.63 

36.99 

80.40 

33.59 

m 

-0.786 

-1  .186 

0.649 

0.577 

0.655 

0.557 

M  cr 

15.97 

19.19 

10.54 

10.54 

10.54 

10.55 

m 

0.003 

-0.000 

0.007 

0.006 

0.008 

0.008 

n  cr 

0.101 

0.260 

0.095 

0.093 

0.096 

0.097 

T  m 

111.5 

-72.05 

68.27 

59.00 

119.7 

135.9 

_  T_ 

2158. 

9710. 

727.3 

709.1 

884.2 

988.9 

Table  13 

Square  Roots  of  Filter-Smoother  Computed  Covariances  with 


Various  Measurement  Devices  --  Trajectory  1 


FS-2 

mm 

RP-2 

RR-1 

RR-2 

Varia 

ble 

V 

m 

or 

1.720 

3.737 

1.519 

3.288 

9.826 

14.31 

3.728 

4.966 

9.432 

13.74 

3.517 

4.858 

X 

m 

Or 

0.031 

0.059 

0.031 

0.058 

0.038 

0.060 

0.036 

0.058 

0.034 

0.056 

0.030 

0.055 

n 

m 

Cr 

0.035 

0.059 

0.032 

0.058 

0.048 

0.060 

0.040 

0.058 

0.045 

0.056 

0.035 

0.055 

D 

m 

or 

mBBm 

10.09 

12.85 

176.1 

236.0 

61.20 

72.82 

168.7 

2  27.2 

52.70 

67.42 

s 

m 

Cr 

18.34 

13.74 

9.400 

12.62 

202.5 

22  2.8 

62.07 

67.91 

202.3 

222.9 

61.02 

67.64 

fl 

m 

Cr 

13.42 

12.71 

6.771 

8.103 

119.7 

137.4 

50.07 

58.71 

119.0 

136.8 

42.42 

46.76 
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Table  14 


Square  Roots  of  Filter-Smoother  Computed  Covariance  with 
Various  Measurement  Devices  --  Trajectory  2 


FS-1 

FS-2 

RP-1 

RP-2  ! 

RR-1 

RR-2 

0. 

960 

1. 

063 

0. 

027 

0. 

047 

0. 

089 

0. 

130 

8  . 

548 

10 

.73 

8  . 

324 

7. 

332 

0.827 

1.045 


0.025 

0.041 


0.079 

0.113 


4.490 
5.  260 


18.77 

25.50 


5.017 

5.729 


0.046 

0.058 


0.102 

0.153 


94.54 

104.0 


42.00 


63.23 

74.48 


2.183 

2.325 


0.034 

0.054 


0.106 

0.147 


28.34 


19.00 

18.31 


5.557 


0.040 

0.042 


0.080 

0.108 


92.69 

101.1 


40.97 

41.24 


58.04 

69.96 


2. 

107 

2. 

273 

0. 

027 

0. 

038 

0. 

080 

0. 

106 

26 

.78 

27 

.83 

18 

.06 

17 

.15 

42 

.68 

32 

.05 

Table  15 

Square  Roots  of  Filter-Smoother  Computed  Covariance  with 
Various  Measurement  Devices  —  Trajectory  3 


Variable 


2.048 

1.888 


0.059 

0.081 


11.85 

49.26 


42.26 


23.95 

23.81 


1. 

862 

1. 

762 

0. 

055 

0. 

077 

11 

.84 

49 

.  26 

7. 

831 

8. 

709 

28 

.55 

37 

.35 

21.26 


8.980 

8.265 


0.089 

0.108 


11.86 

49.27 


67.58 


103.1 


98.08 

74.02 


RP-2 

RR-1 

RR-2 

4.200 

2.968 

8.696 

8.006 

4.007 

2.870 

0.074 

0.095 

0.078 

0.094 

0.063 

0.082 

11.85 

49.26 

11.85 

49.26 

11.85 

49.26 

26.78 

20.32 

66.60 

67.81 

24.66 

17.88 

60.83 

49.58 

104.0 

88.75 

50 . 26 

41.26 

40.85 

28.43 

91.93 

74  .  25 

36.46 

24.16 
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both  forward  and  backward  filters.  Each  of  these  devices 
commonly  produces  an  initial  covariance  transient  which 
reduces  to  a  nearly  steady-state  value  after  a  number  of 
measurements  have  been  processed.  Therefore  the  smoother 
covariance,  which  combined  the  covariances  of  both  filters, 
commonly  displayed  both  transients.  The  backward  filter 
transient  occurred  at  the  end  of  the  time  interval,  since 
that  was  initial  point  for  this  filter. 

Study  of  the  graphical  and  tabular  results  also 
shows  that  radar  measurements  tended  to  reduce  thrust 
"spikes",  compared  to  full  state  measurements,  particularly 
for  trajectories  where  the  thrust  was  held  constant.  This 
can  be  seen  by  comparing  the  temporal  standard  deviations  of 
the  thrust  errors  in  Tables  10,  11,  and  12  for  the  various 
measurement  devices.  Physically,  this  is  attributed  to  a 
tendency  by  the  filter-smoother  to  use  thrust  aggressively 
to  match  velocity,  while  using  load  factor  to  match  flight 
path  angle  and  heading  angle,  when  full  state  measurements 
were  available.  With  radar  measurements,  velocity,  flight 
path  angle,  and  heading  angle  information  had  to  be  derived 
from  time  histories  of  position  data  and  were  assumed  to  be 
less  accurate  by  the  algorithm.  Therefore,  the  controls 
were  varied  less  aggressively. 

Another  general  observation  which  may  be  drawn 
from  a  study  of  Figures  8  and  9  is  that  addition  of  range 
rate  information  to  the  radar  reduces  the  magnitude  of  the 
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filter-smoother  errors.  This  is  again  physically 
reasonable,  as  adding  another  measurement  to  a  radar  may  be 
expected  to  increase  the  accuracy  of  the  device  if  the  range 
and  angle  measurement  errors  remain  constant.  Range  rate  is 
a  particularly  good  choice  for  this  additional  measurement, 
as  it  depends  upon  all  six  components  of  the  state  vector 
(see  Eq  (107) ) . 

It  is  instructive  to  compare  the  magnitudes  of  the 
errors  committed  by  the  filter-smoother  algorithm  with  the 
magnitudes  of  the  square  roots  of  the  corresponding  elements 
of  the  filter-smoother  computed  covariance,  in  terms  of 
their  temporal  means  and  standard  deviations.  Looking  at 
Tables  10  and  13,  we  see  that  for  Trajectory  1,  based  on 
these  data,  the  filter-smoother  tended  to  underestimate  the 
magnitude  of  the  errors  committed.  This  was  consistently 
true  for  all  six  measurement  devices.  We  also  note  that 
when  the  covariance  data  predicted  a  reduction  in  error,  it 
was  not  necessarily  borne  out  by  the  actual  error  data.  For 
Trajectory  2,  by  contrast,  the  filter-smoother  overestimated 
its  errors,  and  reductions  in  the  error  predicted  by  the 
standard  deviation  of  the  covariance  tended  to  predict 
trends  correctly  for  the  standard  deviation  of  the  actual 
errors.  Finally,  for  Trajectory  3,  we  find  that  the 
filter-smoother  sometimes  overpredicted  and  sometimes 
underpredicted  its  errors,  for  all  six  measurement  models. 
Additionally,  in  this  case  the  error  trends  predicted  by  the 
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standard  deviation  of  the  covariance  did  not  correspond  to 
trends  in  the  standard  deviation  of  the  actual  errors  for 
the  full  state  measurement  models,  but  did  for  the  radar 
models. 

These  observations  demonstrate  the  difficulty  in 
using  temporal  averages  and  standard  deviations  to  judge 
filter-smoother  algorithm  performance,  and  attempting  to 
compare  actual  errors  and  algorithm-assumed  errors  on  the 
basis  of  such  statistics.  Recalling  the  development  in 
Section  2.2,  we  note  that  close  correspondence  between 
single-run  errors  and  the  square  roots  of  algorithm-computed 
covariances  is  not  necessarily  to  be  expected.  Error  time 
histories  such  as  those  discussed  above  show  errors 
committed  by  one  particular  filter-smoother  run,  and  depend 
upon  the  one  particular  noise  sequence  encountered  for  that 
run  in  the  dynamics  driving  noise  and  the  measurements.  By 
contrast,  covariance  time  histories  show  how  well  the 
filter-smoother  would  theoretically  estimate  the  states  as  a 
function  of  time,  with  this  estimate  averaged  over  an 
ensemble  of  infinitely  many  filter-smoother  runs,  each  with 
a  different  noise  sequence  in  both  the  dynamics  driving 
noise  and  the  measurements. 

The  results  noted  above  point  out  the  danger  of 
confusing  ensemble  statistics  and  temporal  statistics  of 
given  parameters.  If  time  had  permitted  the  generation  of 
ensemble  averages  of  the  errors  committed  by  the  filter- 
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smoother  algorithm  (as  in  a  Monte  Carlo  evaluation),  then  a 
close  correspondence  to  the  covariance  statistics  could  have 
been  expected.  With  the  procedures  actually  used,  the 
covariance  data  only  provide  an  indication  of  the 
filter-smoother's  internal  estimate  of  its  precision,  and 
should  not  be  used  to  judge  actual  error  characteristics  for 
any  given  case.  However,  these  data  may  still  prove  useful 
for  algorithm  tuning  purposes,  and  for  studies  of  trends. 

Evaluation  of  the  graphical  output  for  the 
remainder  of  the  cases  in  this  study  showed  that  some  of  the 
conclusions  drawn  earlier  may  be  generalized.  The  larger 
the  number  of  available  measurements,  the  less  the  errors 
committed  by  the  filter-smoother.  Radar  measurements  with 
time-invariant  noise  corruption  yield  less  accurate 
Cartesian  position  coordinate  estimates  as  range  increases. 
These  results  are  physically  reasonable,  for  the  reasons 
cited  above,  and  may  prove  valuable  to  users  of  the 
algorithm. 


4 ■ 3  I teration  Effects  and  Procedures 

One  of  the  objectives  of  this  thesis  project  was  to 
determine  whether  the  match  between  the  filter-smoother 
output  and  the  true  trajectory  could  be  improved  by 
successive  iterations  of  the  algorithm.  Accordingly, 
multiple  iterations  were  performed  for  selected  combinations 
of  trajectories  and  measurement  devices. 
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Iterations  were  first  performed  on  the  "benign" 
Trajectory  1,  using  the  FS-1  measurement  device.  The  method 


adopted  was  to  use  the  filter-smoother  computed  control 
inputs  and  initial  states  from  each  run  as  inputs  to  the 
nominal  trajectory  program  (PMSIM,  ref.  Ruley,  1987b)  to 
generate  the  nominal  trajectory  for  the  next  run.  A  total 
of  five  iterations  were  carried  out. 

The  temporal  means  and  standard  deviations  of 
several  parameters  were  recorded  in  an  effort  to  quantify 
any  resulting  improvement  in  the  trajectory  match  and  to  see 
if  this  was  signalled  by  any  easily  recognizable  effect. 
These  parameters  included  the  filter-smoother  state  and 
control  input  perturbations,  the  diagonal  elements  of  the 
filter-smoother  computed  state  covariance,  and  the  change  in 
the  filter-smoother  nominal  trajectory  from  iteration  to 
iteration.  It  was  hoped  that  convergence  of  the  filter- 
smoother  state  and  control  estimates  to  the  true  trajectory 
would  be  reflected  through  recognizable  trends  in  these 
parameters.  Results  obtained  are  discussed  below. 

Before  examining  the  parameters  discussed  above,  it 
was  necessary  to  see  if  convergence  of  the  algorithm  was  in 
fact  occurring.  Table  16  presents  the  means  and  standard 
deviations  of  the  errors  committed  by  the  filter-smoother 
for  the  five  iterations.  Considering  this  table,  we  see 
that  the  iterations  reduced  the  errors  in  velocity  and 
Cartesian  position  coordinates.  Errors  in  flight  path  and 
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Table  16 


Errors  Committed  by  Filter-Smoother  over  Five  Iterations 


for  Trajectory  1 


Iteration 

1 

2 

3 

4 

5 

Variable 

V 

m 

O' 

2.297 

9.937 

-0.485 

7.542 

0.643 

3.305 

-0.084 

5.955 

0.528 

3.423 

X 

m 

cr 

0.705 

0 .500 

-0.621 

0.502 

0.520 

1.335 

-0.652 

0.436 

0 .308 
1.392 

X 

m 

Cr 

0.625 

0.451 

-1.222 

0.470 

0.215 

1.463 

-0.660 

0.413 

0.579 

1.420 

h 

m 

cr 

-1.476 

10.44 

-0.143 

8.267 

-1.667 

6.231 

-1 .705 
5.606 

-1.098 

5.629 

Y 

m 

cr 

10.24 

34.27 

9.249 

33.76 

9 .726 
15.26 

8.850 

21.27 

9.416 

18.28 

X 

m 

cr 

-6.047 

33.04 

13.41 

32.55 

1 .060 
11.84 

7.213 

26.34 

-0.886 

13.60 

M 

m 

Cr 

0.059 

2.084 

0.309 

2.200 

0.257 

2.361 

0.405 

2.456 

0.436 

2.685 

n 

m 

Or 

0.007 

0.519 

-0.001 

0.742 

-0.003 

0.481 

-0.010 

0.730 

-0.003 

0.472 

T 

m 

_ 

31.59 

1575. 

-8.537 

1661. 

53.58 

1985. 

91.29 

2509. 

176.4 

3184. 

heading  angle  were  not  reduced.  However,  these  errors  were 
already  of  very  small  magnitude.  Errors  in  control  inputs 
remained  relatively  constant,  or  even  increased  in  the  case 
of  thrust.  Figure  13  shows  the  errors  committed  by  the 
filter-smoother  after  the  fifth  iteration.  As  stated  in 
Section  3.2,  this  figure  and  other  time  history  plots  may  be 
found  in  the  Appendix.  Comparison  of  Figure  13  with  Figure 
6,  which  shows  the  same  parameters  for  the  first  iteration, 
reinforces  the  conclusions  drawn  above.  Therefore,  at  least 
some  iterative  improvement  was  experienced  in  this  case. 


The  state  and  control  input  perturbations  produced 


by  the  filter-smoother  algorithm  were  tracked  as  one 
possible  means  of  determining  convergence  of  the  iteration 
sequence.  These  quantities  are  defined  by  Eqns  (56)  and 
(88)  -  (90),  and  should  not  be  confused  with  the  filter- 
smoother  errors.  Tab)e  17  shows  the  means  and  standard 
deviations  of  these  parameters  for  the  five  iterations. 

Study  of  the  data  revealed  no  discernible  trend  that  would 
permit  the  user  to  determine  whether  the  errors  committed  by 
the  filter-smoother  were  being  minimized. 


Table  17 

Filter-Smoother  State  and  Control  Perturbations  over  Five 

Iterations  —  Trajectory  1 
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The  next  parameters  examined  as  possible  indicators 
of  convergence  or  minimization  of  the  filter-smoother  errors 


were  the  diagonal  elements  of  the  state  covariance.  Table 
18  presents  these  data,  where  the  square  roots  of  the  actual 
covariance  means  and  standard  deviations  have  been  taken  to 
provide  numbers  which  should  be  more  directly  comparable  in 
magnitude  to  the  actual  filter-smoother  errors.  As  in  the 
case  of  the  state  and  control  perturbations ,  no  trend  was 
observed  which  might  be  correlated  with  the  reduction 
observed  in  actual  filter-smoother  error. 

Finally,  the  change  in  the  nominal  trajectory, 
defined  as  the  difference  between  the  trajectory  used  for 
each  run  of  the  filter-smoother  algorithm  and  that  used  for 
the  next  run,  was  monitored  as  a  possible  indicator  of 


Table  18 


Square  Roots  of  Filter-Smoother  Computed  Covariance  over 
Five  Iterations  --  Trajectory  1 
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convergence.  Table  19  contains  the  relevant  means  and 


standard  deviations.  In  this  case  we  note  that  there  is  a 
definite  trend  which  correlates  with  the  observed  reduction 
in  actual  error  magnitude.  The  changes  in  the  nominal 
trajectory  tended  to  become  smaller  as  the  errors  grew 
smaller.  This  trend  is  not  monotonic,  as  there  are  cases 
where  these  numbers  were  reduced  when  the  filter-smoother 
errors  increased,  and  vice  versa.  However,  it  may  be  used 
as  a  general  indicator  of  algorithm  convergence.  A  sequence 
of  time  history  plots  for  the  nominal  trajectory  change 


Table  19 

Change  in  Filter-Smoother  Nominal  Trajectory  over  Five 
Iterations  —  Trajectory  1 
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would  probably  assist  in  providing  insight  as  to  the  exact 
manner  in  which  changes  are  occurring. 

This  trend  in  the  nominal  trajectory  change  is 
observed  for  the  states  but  less  so  for  the  controls, 
particularly  the  thrust,  which  was  undergoing  less  change 
from  iteration  to  iteration  as  the  error  in  thrust 
increased.  However,  looking  at  Figures  6  and  13,  we  see 
that  the  changes  in  thrust  were  occurring  in  the  form  of 
temporally  narrow  "spikes".  It  is  anticipated  that  these 
affected  the  trajectory  very  little,  since  they  were 
"integrated  out"  by  the  filter-smoother,  and  were  therefore 
less  significant  than  more  slowly-varying  control  input 
changes  of  the  same  order  of  magnitude  would  have  been. 

Thus,  this  lack  of  correspondence  is  not  of  great  concern, 
and  the  tentative  conclusion  is  that  the  sequence  of  nominal 
trajectory  changes  may  be  used  to  help  indicate  convergence 
of  the  filter-smoother  states  to  the  true  states.  Figures 
14  and  15  show  time  histories  of  the  nominal  trajectory 
changes  for  the  first  and  fifth  iterations,  respectively, 
and  show  the  reduction  in  nominal  trajectory  change  between 
these  two  cases. 

Iterations  were  then  performed  on  the  more  "severe" 
Trajectory  3,  using  the  same  techniques  discussed  above  for 
nominal  trajectory  generation,  and  the  radar  with  range  rate 
measurement  device  RR-2.  Table  20  shows  the  results  in 
terms  of  the  means  and  standard  deviations  of  the  errors 
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This  apparently  introduced  normal  acceleration  spikes,  as 
both  normal  acceleration  and  thrust  spikes  are  very  much  in 
evidence  after  the  fifth  iteration  (as  seen  in  Figure  17). 
(The  "flat  spot"  in  normal  acceleration  seen  in  Figure  16  is 
due  to  the  angle-of-a ttack  limiting  discussed  in  Section 
3.2.  Similar  effects  may  be  seen  in  later  figures,  due  to 
the  same  cause.)  The  situation  was  made  more  serious  by 
spikes  and  large  changes  that  occurred  in  roll  attitude  and 
heading  angle  at  approximately  t  =  9.0  sec  ,  at  which  point 
the  aircraft  flew  through  the  vertical.  Since  flight  path 
angle  is  limited  to  ±90  deg,  flight  through  the  vertical 
resulted  in  an  instantaneous  change  of  180  deg  in  both 
heading  angle  and  roll  attitude,  while  flight  path  angle 
peaked  at  90  deg  and  began  to  decrease.  The  filter-smoother 
was  unable  to  follow  these  sudden  changes  closely,  due  to 
the  singularity  which  occurs  in  its  internal  model  at 
vertical  flight  path  angle,  resulting  in  the  generation  of 
the  observed  spikes.  It  should  be  noted  here  that 
calculations  are  performed  within  the  filter-smoother 
algorithm  to  ensure  that  angular  perturbations  are  taken  to 
be  the  smallest  in  magnitude  within  the  ±180  deg  angular 
range.  This  feature  was  implemented  against  the  possibility 
of  the  algorithm  differencing  large  positive  and  large 
negative  angles,  resulting  in  perturbations  which  appear 
numerically  to  be  large  until  appropriately  resolved. 
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All  these  effects  combined  to  cause  the  filter- 
smoother  results  to  diverge  to  some  degree  from  the  true 
trajectory.  Even  though  the  spikes  were  narrow  in  time, 
there  were  enough  of  them  and  they  were  of  sufficient 
magnitude  to  cause  unrealistic  changes  in  the  filter- 
smoother  results.  The  resulting  sequence  of  iterations 
could  not  improve  the  match  between  the  filter-smoother 
output  and  the  true  trajectory. 

In  order  to  rectify  this  deficiency,  it  was  recalled 
from  the  sensitivity  study  that  an  artificial  increase  in 
measurement  corruption  noise  strength  could  assist  in  spike 
suppression.  After  experimentation,  it  was  determined  that 
increasing  all  measurement  noise  covariance  matrix  elements 
by  a  factor  of  125  produced  a  trajectory  for  which  the  match 
with  the  true  states  was  not  degraded,  and  which  was  largely 
devoid  of  control  input  spikes.  Accordingly,  iterations 
were  performed  using  the  same  nominal  trajectory  generation 
technique  discussed  above,  but  with  the  increased 
measurement  corruption  noise.  The  temporal  mean  and 
standard  deviation  of  the  filter-smoother  errors  for  these 
iterations  appears  in  Table  21.  Figures  18  and  19  show  the 
time  history  data  corresponding  to  this  table  for  the  first 
and  fifth  iteration. 

Considering  these  data,  we  see  that  while  the 
agreement  between  the  filter-smoother  results  and  the  true 
trajectory  was  not  being  degraded  by  the  iterations,  it  was 
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also  not  being  improved.  Moreover,  the  error  in  thrust  was 
increasing  with  each  iteration,  and  Figure  19  shows  that 
spikes  were  beginning  to  appear  in  the  filter-smoother 
output,  although  they  were  much  smaller  than  those  ~cen  in 
the  previous  case.  Therefore,  although  this  change  in 
iteration  procedure  improved  matters,  by  reducing  the 
tendency  for  filter-smoother  divergence,  it  did  not  yield 
the  objective  of  algorithm  convergence. 

The  behavior  of  the  filter-smoother  algorithm  in 


this  case  is  easily  explained.  Table  22  shows  the  mean  and 
standard  deviation  of  the  nominal  trajectory  changes  for 
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Change  in  Filter-Smoother  Nominal  Trajectory  over  Five 


Iterations  with  Increased  Measurement  Noise  —  Trajectory  3 
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these  five  iterations.  Examination  of  the  data  shows  that 
the  nominal  trajectory  change  was  nearly  constant  from 
iteration  to  iteration.  What  was  happening  was  that  the 
filter-smoother  control  input  perturbations  were  so  small 
that  the  nominal  trajectory  was  changing  by  only  a  very 
small  amount  from  iteration  to  iteration.  Accordingly,  the 
filter-smoother  was  "solving  the  same  problem"  for  every 
iteration,  and  the  error  in  the  states  remained  the  same. 

The  error  in  the  control  inputs  was  increased  from  iteration 
to  iteration,  since  the  control  perturbation  was  added  to 


the  nominal  control  inputs  at  every  iteration.  Under  these 
circumstances,  iteration  produces  no  benefit. 

Another  iteration  technique  was  tried  with  this 
trajectory  in  a  further  attempt  to  produce  iterative 
improvement.  For  this  method  the  artificially  large 
measurement  corruption  noise  was  retained,  but  nominal 
trajectories  were  generated  simply  by  using  the  resulting 
smoothed  trajectory  from  each  filter-smoother  run  as  the 
nominal  trajectory  for  the  next.  It  was  hoped  that  this 
might  induce  more  rapid  convergence  than  the  method 
previously  used. 

Tables  2?  and  24  show  the  temporal  means  and 
standard  deviations  of  the  filter-smoother  errors  and 
nominal  trajectory  changes,  respectively,  for  the  five 
iterations.  Figure  20  shows  the  error  data  for  the  fifth 
iteration,  and  may  be  compared  with  Figure  15,  which  also 
applies  to  this  case  for  the  first  iteration.  The  nominal 
trajectory  change  data  indicate  that  the  iteration  sequence 
was  converging.  However,  the  error  data  indicate  that  it 
was  converging  to  the  wrong  result.  This  conclusion  is 
based  on  the  fact  that  the  error  magnitudes  were  growing  as 
the  iterations  proceeded. 

This  behavior  is  also  easily  explainable.  The 
validity  of  the  filter-smoother  control  input  perturbation 
estimate  is  based  upon  having  a  consistent  set  of  nominal 
states  and  nominal  controls.  That  is,  the  nominal  control 
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Errors  Committed  by  Filter-Smoother  over  Five  Iterations 
with  Smoothed  Trajectory  used  as  Nominal 
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inputs  must  be  those  which  will  produce  the  nominal  states 
when  applied  to  the  system.  Generating  the  nominal 
trajectory  by  applying  control  inputs  to  an  aircraft  model 
which  solves  the  trajectory  equations  given  by  Eqs 
(11)  -  (16)  guarantees  that  the  required  consistency  will  be 
maintained,  because  the  filter-smoother's  linearized  model 
is  generated  from  the  time  histories  of  the  resulting 
nominal  states  and  controls.  However,  if  the  nominal  states 
are  produced  without  reference  to  the  nominal  controls,  as 
in  the  case  where  smoother  results  are  used  as  nominal 
trajectory  states,  then  these  states  and  controls  cease  to 
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Change  in  Filter-Smoother  Nominal  Trajectory  over  Five 
Iterations  with  Smoothed  Trajectory  used  as  Nominal 
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correspond.  The  filter-smoother's  internal  model  will  not 
be  correctly  relinearized,  and  the  results  will  become 
unreliable. 

Having  examined  three  different  techniques  for 
iterative  improvement  and  noting  the  good  points  and 
shortcomings  of  each,  a  few  words  of  summation  are  now 
appropriate.  From  the  results  above,  it  appears  that  the 
best  way  to  proceed  is  to  run  the  filter-smoother  once  with 
measurement  corruption  noise  matched  as  closely  as  possible 
to  the  "real-world"  value.  Should  this  result  in  spikes  in 
the  control  input  estimates,  one  may  artificially  increase 
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the  measurement  corruption  noise  to  a  level  which  suppresses 
these,  if  this  may  be  done  without  spoiling  the  agreement 
between  the  filter-smoother  states  and  the  nominal  states. 
Iterations  may  then  be  performed,  and  the  nominal  trajectory 
sequence  may  be  monitored  for  indications  of  convergence. 
This  will  generally  be  indicated  by  a  reduction  in  the 
nominal  trajectory  change  from  iteration  to  iteration,  for 
both  the  nominal  states  and  the  nominal  controls.  The 
nominal  trajectories  used  for  iterations  must  be  generated 
by  applying  the  filter-smoother  estimates  of  control  inputs 
to  an  aircraft  model  implementing  the  trajectory  equations 
given  by  Eqs  (11)  -  (16). 

While  it  is  possible  that  iterations  will  improve 
the  agreement  of  the  filter-smoother  results  and  the  true 
trajectory,  this  is  not  guaranteed.  If  the  nominal 
trajectory  changes  do  not  tend  to  converge,  then  iterations 
cannot  be  expected  to  improve  the  agreement  between  the  true 
trajectory  and  the  filter-smoother  output. 


4 . 4  Chapter  Summary 

Chapter  IV  discusses  the  evaluation  of  the  filter- 
smoother  algorithm's  performance.  This  was  composed  of  a 
robustness  study,  a  measurement  precision  evaluation,  and  an 
assessment  of  the  effects  of  iterations  on  the  accuracy  of 
the  filter-smoother  results.  The  robustness  study  showed 
that  filter-smoother  performance  was  not  greatly  affected  by 
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relatively  large  mismatches  between  the  noise  statistics 
used  by  the  algorithm  and  those  used  to  generate  the  true 
trajectory.  Moreover,  this  study  showed  that  artificially 
increasing  elements  of  the  measurement  noise  covariance 
matrix  could  help  reduce  unrealistic  transients  in  the 
smoothed  estimates  of  the  control  inputs.  The  measurement 
precision  evaluation  demonstrated  that  the  algorithm 
responded  to  changes  in  measurement  device  characteristics 
in  a  physically  reasonable  manner.  Finally,  the  iteration 
study  showed  that  iterations  could  improve  the  match  between 
the  filter-smoother  state  and  control  estimates  and  the  true 
trajectory.  However,  this  improvement  was  not  guaranteed  to 
occur  for  all  trajectories.  Methods  were  evaluated  for 
assisting  this  iterative  improvement  by  artificially  raising 
the  magnitude  of  the  filter-smoother  measurement  corruption 
noise  covariance  matrix,  to  reduce  the  magnitude  of  the 
"spikes"  in  the  smoother-estimated  time  histories.  Several 
parameters  were  evaluated  as  possible  indicators  of 
convergence  for  a  sequence  of  filter-smoother  iterations, 
and  the  change  in  the  nominal  trajectory  from  iteration  to 
iteration  was  found  to  be  fairly  reliable  as  such  an 


indicator. 


V.  Conclusions  and  Recommendations 


5 . 1  Conclusions 

The  preceding  chapters  have  shown  how  the 
filter-smoother  algorithm  was  developed,  implemented,  and 
evaluated.  Conclusions  will  now  be  drawn  from  previous 
work,  and  ways  in  which  the  current  implementation  night  be 
improved  will  be  considered. 

The  most  important  conclusion  to  be  drawn  is  that 
the  objectives  outlined  in  Chapter  1  have  been  achieved. 
G’ven  a  nominal  trajectory  which  reasonably  well  matches  the 
measured  data,  a  set  of  nominal  control  inputs  which  will 
generate  that  trajectory  when  applied  to  the  aircraft  model, 
and  measured  data  which  is  corrupted  by  a  zero-mean, 
Gaussian-distributed  white  noise  sequence,  the  filter- 
smoother  will  produce  an  output  trajectory  which  matches  the 
true  trajectory  well.  This  holds  even  when  the  noise 
statistics  assumed  by  the  algorithm  do  not  correspond  to  the 
true  values,  and  for  several  different  measurement  devices. 

However,  as  currently  implemented,  the  filter- 
smoother  algorithm  is  not  an  infallible  predictor  of  true 
trajectories,  and  has  some  limitations.  Some  of  these 
shortcomings  are  serious,  and  users  must  bear  them  in  mind. 

A  very  serious  limitation  is  the  dependence  of  the 
algorithm  on  the  provision  of  a  nominal  trajectory  which 
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closely  matches  the  measurements,  and  on  a  set  of  nominal 
control  inputs  which  correspond  to  the  nominal  states.  The 
situation  where  the  original  nominal  states  are  ill-matched 
to  the  measurements  was  not  addressed  in  this  thesis. 
Therefore,  it  may  not  be  assumed  that  the  algorithm  gives 
satisfactory  performance  under  such  circumstances. 
Additionally,  it  has  been  shown  that  if  the  nominal  control 
inputs  and  states  do  not  correspond,  the  filter-smoother 
output  may  diverge  from  the  true  trajectory.  Accordingly, 
if  good  results  from  the  current  algorithm  are  to  be 
expected,  the  user  must  provide  a  consistent  set  of  nominal 
states  and  nominal  control  inputs,  and  they  must  match  the 
measurements  closely.  This  limitation  will  be  given  further 
attention  in  Section  5.2  below. 

Another  limitation  of  the  current  filter-smoother 
implementation  is  that  iterations  may  not  improve  the  match 
between  the  smoothed  and  true  trajectories.  In  fact,  when 
the  trajectory  includes  singularities  of  the  filter- 
smoother's  linearized  aircraft  model,  iterations  of  the 
algorithm  may  actually  cause  poorer  agreement.  However, 
monitoring  the  degree  of  change  in  the  nominal  trajectory 
from  iteration  to  iteration  will  indicate  whether  or  not 
iterations  are  helpful. 

The  tendency  of  the  filter-smoother  to  corrupt  the 
control  input  estimates  with  artificially  generated  "spikes" 
is  also  a  limitation  to  be  considered.  A  method  for 
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eliminating  this  tendency  by  increasing  the  measurement 
corruption  noise  covariance  has  been  shown  to  be  effective. 
However,  this  method  may  have  the  undesirable  consequence  of 
making  iterations  of  the  algorithm  slow  to  converge. 
Additional  proposed  solutions  for  this  problem  will  be 
discussed  in  Section  5.2. 

Despite  these  limitations,  the  filter-smoother 
algorithm  is  a  useful  tool,  which  could  be  of  assistance  in 
actual  aircraft  mishap  investigations.  Ways  in  which  it 
could  be  improved  will  now  be  discussed. 


5 . 2  Recommendations 

The  generation  of  nominal  trajectories  which  meet 
the  requirements  discussed  above  warrants  further  attention. 
A  possible  method  for  doing  this  in  a  systematic  manner  is 
to  use  a  curve-fitting  algorithm  to  "smooth"  the  actual 
measurement  time  histories  (in  the  sense  of  introducing 
continuous  second  derivatives)  and  then  to  differentiate 
them  numerically  to  obtain  the  control  input  time  histories. 
These  control  inputs  could  then  be  applied  to  a  nonlinear 
model  of  the  aircraft,  such  as  the  PMSIM  program  (Ruley, 
1987b),  and  used  to  generate  a  candidate  nominal  trajectory 
which  may  be  compared  with  the  measurements.  Further 
adjustments  of  the  control  inputs  could  then  be  made  in  a 
trial-and-er ror  fashion  to  improve  the  agreement  between  the 
nominal  trajectory  and  the  measurements.  A  program  to 
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explore  this  technique  has  been  written,  using  the  raw 


measurement  data  for  selected  cases,  and  has  shown  that 


valuable  "trend"  information  could  be  deduced  from  raw 


measurements.  Additional  study  of  this  technique  is 


recommended . 


A  possible  method  for  elimination  of  spikes  in  the 


control  input  estimates  would  be  to  change  the  implementa¬ 


tion  of  the  filter-smoother  so  that  the  current  state  vector 


is  augmented  with  the  current  control  inputs,  and  the  time 


derivatives  of  the  current  control  inputs  are  used  as  new 


"controls".  While  spikes  might  still  occur  in  these 


’controls",  it  is  probable  that  they  would  be  less  likely  to 


occur  in  the  roll  attitude,  normal  acceleration,  and  thrust 


output,  since  these  would  now  be  treated  as  filter-smoother 


states.  This  technique  would  also  permit  the  modelling  of 


additional  measurement  devices,  such  as  a  head-up  display 


(HUD),  which  record  variables  which  are  used  as  controls  in 


the  current  implemen ta t i on.  Inclusion  of  these  additional 


measurements  would  be  very  likely  to  make  the  filter- 


smoother  algorithm  more  capable, 


Other  methods  for  elimination  or  reduction  of 


control  input  "spikes"  associated  with  model  singularities 


are  possible.  One  of  these  would  be  to  increase  the  values 


in  the  measurement  corruption  noise  covariance  matrix  as  the 


trajectory  nears  a  singular  point.  This  would  cause  the 


algorithm  to  give  less  weight  to  measurements  at  that  point. 
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and  to  follow  the  nominal  trajectory  until  the  singularity 
had  been  passed.  Another  way  to  accomplish  the  same 
objective  would  be  to  re-formulate  the  aircraft  model  with 
Euler  parameters  or  quaternions  (McKern,  1968;  Whittaker, 
1944:8)  used  in  place  of  Euler  angles.  These  parameters  do 
not  exhibit  the  singular  behavior  associated  with  Euler 
angles,  and  the  adverse  effects  of  the  singularities  could 
thus  be  eliminated.  Finally,  some  evaluation  of  the  effects 
of  artificially  increased  dynamics  driving  noise  on  the 
"spikes"  might  prove  profitable.  The  actual  driving  noise 
strength  will  probably  not  be  as  well  established  as 
measurement  noise  covariance  for  practical  problems,  and 
thus  the  matrix  ^(t^)  could  be  manipulated  as  well  as  the 
matrix  R(t^)  in  order  to  obtain  good  results. 

At  present,  the  filter-smoother  algorithm  requires  a 
nominal  trajectory  which  is  well  matched  to  the 
measurements.  Suggestions  for  generating  such  trajectories 
have  already  been  made.  An  alternate  approach,  which  might 
relax  this  requirement  to  some  degree,  would  be  to  increase 
the  magnitude  of  the  dynamics  driving  noise  strength  matrix. 
This  is  expected  to  permit  convergence  of  the  iterations 
despite  a  poorer  match  between  the  initial  nominal 
trajectory  and  the  measurements.  Some  increase  in  the  noise 
statistics  is  to  be  recommended  anyway,  since  one  ought  to 
account  for  the  model  inadequacy  introduced  by  the 


first-order  Taylor  series  expansions  used  to  generate  the 
state  and  measurement  models. 


Finally,  the  model  is  limited  at  present  by  the 
assumptions  that  thrust  acts  along  the  velocity  vector  and 
that  side  force  is  negligible.  These  assuptions  reduce  the 
utility  of  the  algorithm,  as  some  mishap  scenarios  involve 
high  angles  of  attack  and  sideslip.  Attention  should  be 
given  to  removing  these  limitations  by  modifying  the 
equations  of  motion  appropriately.  Some  additional 
complexity  would  be  introduced,  but  this  would  probably  be 
justified  by  the  resulting  increase  in  algorithm  utility. 
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Appendix:  Trajectory  Time  History  Plots 


This  Appendix  includes  Figures  2  -  20,  which  are 
plots  of  the  time  histories  of  variables  processed  by  the 
filter-smoother  algorithm.  Features  of  plot  symbology  and 
characteristics  which  have  not  been  mentioned  in  the  text 
are  discussed  below. 

Figures  2-4  are  plots  of  the  true  trajectories  and 
measurement  data  for  Trajectories  1-3,  described  in 
Section  3.2.  In  these  plots  the  solid  lines  represent  the 
true  trajectory,  and  the  plus  signs  represent  measured  data 
points . 

Figure  5  is  a  plot  of  the  smoother  output  trajectory 
and  the  true  trajectory  for  the  baseline  case  described  in 
Section  4.1.  in  this  figure  the  solid  line  represents  the 
filter-smoother  output,  while  the  plus  signs  represent  the 
true  trajectory.  In  all  succeeding  figures  only  one  solid 
line  appears,  which  is  defined  as  indicated  in  the  text  and 
by  the  figure  title. 

In  the  roll  attitude  trace  of  Figure  3,  the  reader 
will  observe  what  appears  to  be  a  "jump"  discontinuity  in 
the  data.  This  effect  is  caused  by  the  plotting  software, 
which  restricts  all  angles  to  the  ±180  deg  range.  A  related 
effect  occurs  in  Figure  4.  In  this  figure,  at  a  time 
shortly  before  9  sec,  the  aircraft  flies  through  the 
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vertical,  defined  by  a  flight  path  angle  of  90  deg.  In 
accordance  with  conventional  practice,  the  plotting  software 
limits  flight  path  angle  to  ±90  deg,  and  changes  roll 
attitude  and  heading  angle  by  180  deg  when  the  aircraft 
flies  through  the  vertical.  These  effects  are  seen  in 
Figure  4  as  an  abrupt  change  in  slope  in  the  flight  path 
angle  plot,  and  180  deg  "jumps"  in  the  heading  angle  and 
roll  attitude  plots. 

Additional  jumps  seen  later  in  the  heading  angle  and 
roll  attitude  plots  in  Figure  4  are  due  to  the  angular  range 
limit  discussed  above.  The  first  several  of  these, 
occurring  between  t  =  9  sec  and  t  =  12  sec  ,  are  caused 
by  the  aircraft  flying  at  a  roll  attitude  of  approximately 
180  deg.  As  noise  is  introduced,  the  roll  attitude  goes 
back  and  forth  between  +180  deg  and  -180  deg.  The  second 
group  of  jumps  occur  at  the  end  of  the  trajectory  and  are 
caused  by  the  aircraft  being  put  through  several  360  deg 
rolls.  All  of  these  discontinuities  occur  in  the  plotting 
software,  and  do  not  mean  that  discontinuities  are  occurring 
in  the  data  being  processed  by  the  filter-smoother 
algorithm. 

The  reader  is  cautioned  that  the  scales  appearing  on 
the  plots  were  set  automatically  within  the  plotting 
software.  Therefore,  care  is  required  when  comparing 
corresponding  plots,  as  the  scales  are  usually  different. 
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Figure  2  (continued) 
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Figure  3  (continued) 
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Figure  4.  Time  Histories  of  True  States  and  Control  Inputs 

for  Trajectory  3 
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Figure  4  (continued) 
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Figure  5.  Time  Histories  of  Smoothed  and  True  Trajectories 

for  Baseline  Case 
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Figure  6.  Time  Histories  of  Errors  Committed  by 
Filter-Smoother  Algorithm  for  Baseline  Case 


-99- 


y 

y 

y 

.N. 

A 

L, 


V 


,  ^  W H  k  ^  » 


SMTD.  -  TRUE  ALTITUDE  VS.  TIME 


SMTD.  -  TRUE  Y-COORD.  VS.  TIME 


Figure  6  (continued) 
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Figure  7  (continued) 
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Figure  7  (continued) 
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Figure  8.  Errors  Committed  by  Filter-Smoother 
Algorithm  for  Trajectory  2,  Measurement  Model  RP-2 
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Figure  8  (continued) 
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Figure  9.  Errors  Committed  by  Filter-Smoother 
Algorithm  for  Trajectory  2,  Measurement  Model  RR-2 
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Figure  10.  Diagonal  Elements  of  Filter-Smoother  Computed 
Covariance  for  Trajectory  2,  Measurement  Model  FS-1 


-111- 


,  •r.  A  V-  «r. 


c  ece  o  m  a  za-  o  sat  a  sat  o  t  o  a  boss 

( Xd**i J )  (fr'fr)d  (S'sld  (jjxjj)  ( 9  ‘  9 )  d 


~r '?  ■'  v  v  /  -J-  -j-  -j-  -» 


TIME,  SEC 


VELOCITY  COVRRIRNCE  VS .  TIME 


MEAN  - 


4.?64725l 


SIGMR  -  5.4036990 


i-\ - ! - 1 - 1 - (- - 1 - i - 1 - I - 1 - 1 

0  0  i  .  4  -•  E  3  6  *  .0  c  12  6  14  1  If  o  16. Q  21  0 

T 1 .  srp 

ALT.  PATH  ANGLE  covariance  vs.  tine 

S  Mf.BN  - _ D.3ai  !3iB  SIGMR  -  Q.Q0293fi7 


0  0  2.1  4  2  6.3  8.4  10.  *5  126  14.’  16.3  13  9  21.0 

TIME,  SEC 

.HEADING  ANGLE  COVARIANCE  VS.  TINE 


K  mean  - 


0.0111623 


SI  GAR 


0.0216805 


6  4  10 .5  12.6  14 

TIME,  SEC 


16.8  16  9  21.0 


s  it  o  z-  r — UiOb  8  J>90  >  88^  0-  ~Ti0U9G'0  &Z40Z0 

( 03SO3S/J.  J*I  J )  ( 1'  l  Id  t.Ol*  (33Q**03OJ  <?'Z)d  030*330) 


TIME,  SEC 


-T.  PATH  ANGLE  COVARIANCE  VS.  TIME 


HEADING  ANGLE  COVARIANCE  VS.  TIME 


P(6,6)  (PT«m  Pt5,5>  (FT*FT)  P(4^)  (FT*FT) 

32SS  5  710<  0  -64.0  50?  5  1239  0  -350  0  1866.0 


SMTD.  -  TRUE  VELOCITY  VS.  TIME 


SMTD 


TR.  HDG .  RNG .  VS.  TIME 


e> 

& 

*» 

UJ 

_) 

CD 

z 

<r  - 

cs 

z 


> _ L 

H 

B 

m 

■ 

■ 

m 

(US 

RR 

■ 

m 

■ 

— 

m 

— 

— 

00  40  80  12  0  16.0  20.0  24  0 

TIME,  SEC 


26  0 


32.0 


36.0 


40  0 


Figure  13.  Errors  Committed  by  Filter-Smoother 
after  5  Iterations  --  Trajectory  1,  Measurement  Model  FS-1 
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Figure  13  (continued) 
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Figure  14.  Change  in  Nominal  Trajectory  for  Iteration  1  of 
Filter-Smoother  --  Trajectory  1,  Measurement  Model  FS-1 
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Figure  15.  Change  in  Nominal  Trajectory  for  Iteration  5  of 
Filter-Smoother  --  Trajectory  1,  Measurement  Model  FS-1 
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Figure  18.  Errors  Committed  by  Filter-Smoother 
with  Increased  Measurement  Noise  --  Trajectory  3 
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Figure  18  (continued) 
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Figure  19.  Errors  Committed  by  Filter-Smoother 
with  Increased  Measurement  Noise  --  Trajectory  3 
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Figure  19  (continued) 
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